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步行 机 器 人 具有 良好 的 地 形 适 应 性 ， 在 诸如 救灾 救援 、 星 球 探 
测 、 军 事 侦 察 等 复杂 情况 下 具有 广阔 的 应 用 前 景 ， 能 够 执行 传统 轮 式 
机 器 人 和 履带 机 器 人 不 能 执行 的 任务 ， 受 到 学 术 界 和 工程 界 的 广泛 关 
注 。 足 式 机 器 人 分 为 单 足 、 双 足 及 多 足 等 多 种 形式 ， 其 中 四 足 机 器 人 
兼 具 静 态 稳定 步 态 和 动态 稳定 步 态 ， 除 具备 良好 地 形 适 应 能 力 外 ， 还 
可 实现 较 高 移动 速度 、 较 大 的 承载 能 力 和 较 低 的 自重 ， 近 年 来 成 为 该 
领域 研究 热点 。 

本 书 阅 述 了 作者 十 几 年 间 在 机 妖 人 方面 所 做 的 研究 ， 并 以 SILO4 
四 足 步行 机 器 人 为 例 ， 分 析 探 讨 了 四 足 机 器 人 传统 的 稳定 性 判别 算 
法 ， 并 引入 了 作者 最 新 的 研究 成 果 ， 比 较 了 各 种 算法 之 间 的 优 务 ; 
论述 了 四 足 机 器 人 的 规则 步 态 及 自由 步 态 的 步 态 生成 算法 ， 并 通 
过 仿真 计算 验证 了 算法 的 有 效 性 ; 介绍 了 四 足 机 器 人 腿 部 运动 学 、 
动力 学 分 析 、 驱 动 系统 计算 及 运动 控制 算法 等 关键 问题 。 本 书 可 
为 工程 设计 人 员 提 供 参 考 ， 同 时 对 四 足 机 器 人 的 科普 教育 具有 一 
定 意 义 。 
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由 于 译 者 水 平 有 限 ， 书 中 有 不 妥 或 者 错误 之 处 ， 欢 迎 读者 朋友 批评 
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步行 机 器 人 已 经 被 证 明 是 杰出 的 运动 系统 ， 能 够 执行 常规 车 辆 不 
能 执行 的 任务 。 更 令 人 兴奋 的 是 ， 对 于 来 自 不 同学 科 的 探索 人 员 ， 这 
是 一 个 快速 发 展 的 研究 领域 。 在 过 去 30 年 里 ， 足 式 运 动 技术 已 经 在 世 
界 各 地 发 展 ， 出 现 了 许多 重要 的 新 机 器 和 新 方法 。 但 是 ， 关 于 多 足 机 
器 人 的 专著 却 届 指 可 数 。 本 书 的 主要 目标 是 探讨 分 析 过 去 10 年 间作 者 
所 做 的 一 些 重要 研究 ; 次 要 目标 是 写 一 本 只 论述 四 足 运 动 的 书 ， 也 是 
第 一 本 关于 四 足 运动 的 专著 。 本 书 分 为 步行 测量 和 算法 以 及 控制 技术 
两 部 分 。 第 一 部 分 专门 介绍 四 足 运 动 的 理论 方面 。 第 1 章 介 绍 多 足 机 
器 人 的 发 展 历史 ， 重 点 介绍 优 缺点 、 主 要 特点 、 洪 力 和 实际 应 用 ， 并 
讨论 一 些 基本 概念 以 及 四 足 和 六 足 之 间 的 权衡 。 最 后 说 明 四 足 运动 最 
新 的 和 传统 的 稳定 性 测量 和 步 态 生 成 算法 。 第 二 部 分 介绍 一 般 设 计 和 
控制 算法 〈 运 动 学 和 动力 学 )， 间 在 提高 机 器 人 的 主要 技术 特征 ， 如 
速度 、 接 地 检测 和 接口 等 。 一 般 来 说 ， 这 些 技 术 用 于 足 式 机 器 人 ， 本 
书 将 它们 专门 应 用 于 四 足 步 行 机 器 人 。 本 书 是 团体 共同 努力 的 成 果 。 
特别 感谢 工业 自动 化 研究 所 (CSIC) 的 会 员 对 SILO4 步行 机 器 人 的 加 
工 和 维护 ， 以 及 许多 有 价值 的 贡献 。 还 要 感谢 在 自动 化 控制 系 的 同事 
们 ， 他 们 为 实验 工作 提供 了 直接 的 帮助 。 非 常 感谢 部 门 主 管 
M. Armada 博士 的 无 条 件 支持 。 感 谢 M. A. Jimenez 博士 的 贡献 ， 她 本 
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步行 测量 和 算法 


PLB 步行 机 器 人 概述 


1.1 简介 


自然 界 由 美妙 的 生物 组 成 ， 人 类 对 它们 的 行为 感到 好 奇 ， 甚 至 兴奋 ， 并 尝试 
了 解 、 欣 赏 或 模仿 它们 。 模 拟 生物 性 能 是 一 个 有 吸引 力 的 想法 ， 但 非常 难以 完 
成 。 通常 ， 人 类 制作 简单 的 装置 来 模仿 生物 的 视觉 、 嗅 觉 、 肢 体操 作 和 行走 等 容 
易 感 知 的 特性 。 

本 书 致力 于 通过 步行 机 器 的 发 展 模拟 步行 ， 即 众所周知 的 机 器 人 8; 换 句 话 
说 ， 是 机 械 系 统 通过 使 用 类 似 于 腿 的 装置 来 移动 自身 。 根 据 机 器 人 腿 的 数量 ， 可 
分 为 类 似 人 类 或 鸟 类 的 两 足 、 类 似 哺乳 动物 和 有 疏 行 动物 的 四 足 、 类 似 昆 虫 的 六 足 
和 类 似 蜘 蛛 的 八 足 。 机 器 人 有 一 个 足 [Raibert's hopper(1986)]、 三 个 足 [OSU 
Triped (Berns，2005)]、 五 个 足 [Hitachi hybrid robot (Todd，1985)]、 八 个 
Æ [ReCUS (Ishino 等 ，1983)] 或 更 多 足 [Nonaped, (Zykov 等 ，2004)] 是 
不 常见 的 ， 但 也 并 非 不 可 能 。 本 书 特 别 关 注 四 足 步行 静态 稳定 性 ， 即 具有 四 条 腿 
的 机 器 具有 的 一 些 特殊 功能 ， 以 及 使 用 特定 的 控制 算法 ， 将 在 后 面 重 点 论述 。 不 
过 ， 不 可 避免 地 会 提 到 其 他 的 多 足 机 器 人 〈 不 包括 单 足 和 双 足 ) 和 相关 功能 。 

1870 年 前 后 出 现 了 第 一 个 记录 在 案 的 步行 机 器 ， 是 俄罗斯 数学 家 
P. L. Chebyshev 基于 四 杆 机 制 发 明 的 ， 试 图 模仿 自然 步行 (Artobolevsky， 
1964) 。 后 来 开发 出 一 些 用 于 休闲 娱乐 的 机 器 ，1893 年 前 后 ， 美 国 专利 局 注册 了 
第 一 个 腿 式 系统 的 专利 。 

几 十 年 后 ， 大 约 在 1940 年 ， 研 究 人 员 开 始 考虑 将 步行 机 器 人 用 于 实际 应 用 
的 可 能 性 。 按 照 惯 例 ， 军 方 应 用 排 在 第 一 位 。 英 国 和 美国 军 方 赞助 了 一 些 重要 项 
目 ， 研 究 作为 战争 机 器 的 步行 机 器 的 应 用 。 后 来 ， 基 于 步行 机 器 人 理论 上 的 优 
点 ， 很 多 任务 被 设想 为 步行 机 器 人 的 前 上 脆性 应 用 。 

创造 步行 机 构 的 挑战 令 人 着 迷 ， 但 在 当时 又 非常 复杂 ， 研 究 人 员 并 不 总 是 成 
功 。 尽 管 如 此 ， 在 此 期 间 仍 然 设 计 和 制作 了 一 些 实物 。 随 着 计算 机 技术 的 发 展 ， 


@ 本 章 不 讨论 由 操作 员 直 接 控制 的 步行 机 器 是 否 是 机 器 人 的 问题 。 无 论 如 何 ， 腿 部 运动 的 序列 是 自 
动 执 行 的 ， 因 此 ， 机器、 车 辆 和 机 器 人 这 些 术 语 会 交替 使 用 。 
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研究 人 员 开 始 利用 强大 而 紧凑 的 电脑 时 ， 步 行 机 器 人 的 数量 有 所 增加 ， 而 且 更 加 
成 功 。 到 20 世纪 70 年 代 中 期 ， 第 一 台 计 算 机 控制 的 步行 机 器 人 COSU) ERZ 
俄 州立 大 学 进行 了 测试 。 之 后 ， 美 国 、 日 本 的 大 学 和 研究 中 心 在 这 一 领域 开展 了 
大 量 的 工作 ， 其 中 包括 被 认为 是 奇迹 的 步行 车 辆 的 开发 。 在 欧洲 的 研究 延迟 了 几 
年 。 大 约 在 1972 年 ， 意 大 利 罗马 大 学 (Mocci 等 ，1972) 第 一 个 步行 机 器 人 被 
记录 在 案 。 但 1977 年 莫斯科 生理 技术 研究 所 开发 的 六 足 机 器 人 在 当时 被 报道 为 
欧洲 的 第 一 个 步行 机 器 人 (Gurfinkel 等 ，1981) 。 

步行 机 器 人 与 传统 的 移动 系统 相 比 具有 许多 理论 上 的 优势 ， 科 学 界 开发 了 大 
量 计算 机 控制 的 步行 机 器 人 ， 用 以 证 明 其 理论 上 的 优势 (Berns，2005)。 但 是 ， 
这 些 机 器 人 中 的 大 多 数 仍然 以 简单 的 实验 室 原型 机 的 形式 存在 。 只 有 少数 步行 机 
器 人 具备 了 实用 特性 ， 如 ASV (Song 和 Waldron, 1989), Dante (Bares 和 
Wettergreen, 1999) 和 Timberjack (Plustech- Oy, 2005) 等 ， 尽管 它们 远 没 
有 达到 当时 轮 式 和 履带 机 器 人 的 性 能 。 目 前 步行 机 器 人 技术 发 展 滞后 的 原因 主要 
是 步行 机 器 人 比 预期 的 更 复杂 ， 不 仅 在 机 械 方 面 ， 而 且 也 包括 电子 系统 、 感 知 和 
控制 算法 方面 。 

基于 作者 以 前 的 经 验 ， 本 书 介 绍 了 与 四 足 机 器 人 静态 稳定 控制 算法 设计 相关 
的 一 些 基本 概念 ， 如 RIMHO (Jimenez 等 ，1993) 、ROWER (Gonzalez de San- 
tos 等 ，2000) 和 SILO4® (Gonzalez de Santos 等 ，2003)。 从 工程 角度 来 看 ， 
这 些 技术 专门 用 于 四 足 静 态 稳定 控制 。 动 态 稳定 的 算法 和 仿生 机 器 人 超出 了 本 书 
的 范围 。 本 章 将 介绍 一 般 的 步行 机 器 人 ， 包 括 步行 机 器 人 的 发 展 历史 等 ， 步 态 运 
动 相 对 于 传动 轮 式 运动 的 优点 、 前 景 ， 真 实 步行 机 器 人 的 应 用 ， 四 足 机 器 人 和 六 
足 机 器 人 的 比较 研究 以 及 迄今 已 建成 的 最 常见 的 机 器 人 类 型 。 


1.2 发 展 历史 


步 态 运 动 技术 发 展 起 始 于 类 似 玩 具 的 简单 步行 机 器 ， 能 够 在 平坦 地 形 等 有 利 
条 件 下 行走 移动 。 后 来 ， 科 学 家 通过 观察 和 记录 某 些 物种 的 步行 模式 尝试 了 解 生 
物 的 运动 。 然 后 制定 了 步 态 并 根据 数学 模型 进行 了 研究 ， 试 图 改善 步行 机 器 的 特 
性 。 因 此 ， 基 于 理想 情况 ， 创 建 稳定 性 测量 和 步 态 生成 算法 ， 并 进行 改进 ， 最 终 
达到 现 有 的 技术 水 平 。 

为 了 解 步行 机 器 的 发 展 历史 ， 应 当 首先 了 解 人 类 和 动物 在 步行 方法 研究 方面 
的 成 果 。 本 节 将 重点 关注 机 构 和 算法 相关 的 成 果 ， 而 不 提 及 关于 运动 摄影 报告 
(Muybridge, 1957) 以 及 动物 学 和 生物 学 的 比较 研究 (Wilson，1966; Alexan- 


@ RIMHO, ROWER 和 SILO4 由 西班牙 国家 研究 委员 会 工业 自动 化 研究 所 开发 。 
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der, 1977; McMahon, 1984) 等 其 他 成 果 。 

本 节 涵 盖 了 步行 机 器 人 发 展 中 最 重要 的 历史 里 程 碑 。 这 是 基于 Orin (1976) 
Todd (1985), Raibert (1986), Messuri (1985) 以 及 Song 和 Waldron (1989) 
所 做 的 工作 。 对 步行 机 器 人 的 历史 发 展 感 兴趣 的 读者 ， 我 们 推荐 以 上 这 些 作者 撰 
写 的 书籍 和 博士 论文 。 


1.2.1 步行 机 构 


如 前 所 述 ， 第 一 个 步行 机 器 是 在 1870 年 前 后 ， 由 Chebyshev 基于 他 20 年 前 
提出 的 想法 建成 的 。 它 由 一 个 基于 四 连 杆 的 装置 组 成 ， 如 图 1. 1 所 示 。 当 连 杆 1 
围绕 垂直 于 平面 的 轴线 A, 旋转 时 ， 在 一 个 步 态 周期 内 ， 足 (点 P1) 接触 地 面 时 
遵循 准 直 线 轨迹 TT ， 离 开 地 面 时 遵循 轨迹 T;,。 轨 迹 的 形状 和 直线 T 的 质量 取 
决 于 连 杆 长 度 。 由 图 1.1 (a) 可 知 ，AiA; =0.15m, A,A,=0.41m, AA, = 
0.4m，Ai Pi=0.9m，AiA:,=0.3m。 使 用 这 种 简单 的 装置 ， 可 以 交替 支撑 ( 姿 
A) 和 转移 (摆动 ) 相位 8。 这 种 由 Chebyshev 设计 的 步行 机 器 和 草 绘 图 如 图 
1.1 b) 所 示 ， 双 腿 成 对 安装 〈 对 侧 ， 非 相 邻 腿 ) 。 因 此 ， 通 过 每 一 对 腿 支 撑 相 
和 摆动 相 的 交替 (对 角 步 态 ) 就 可 能 实现 小 跑 。 但 是 ， 这 种 设备 只 能 应 用 在 完全 
平坦 的 地 形 上 ， 因 为 它 没有 地 形 适应 机 制 或 独立 的 腿 部 运动 ， 从 而 限制 了 立足 点 
的 选择 。 尽 管 如 此 ， 在 19 世纪 最 后 一 个 季度 ，Chebyshev 步行 机 器 也 被 纳入 两 
个 著名 的 机 器 中 ， 即 MELWALK (Kaneko 等 ，1985) 和 Dante (Wettergreen 
等 ，1993)。 

在 开发 Chebyshev 机 器 之 前 ， 已 经 开发 出 了 并 不 是 真正 步行 系统 的 令 人 惊 
讶 的 移动 设备 ， 其 基本 用 途 是 为 了 娱乐 。Vaucanson 建造 的 机 械 鸭 (1738), Fr 
土 制 表 师 Jacquet - Droz 大 约 在 1774 年 建造 的 机 器 作家 、 机 器 音乐 家 和 机 器 绘图 
RÆ 〈Logsdon，1984)。 这 些 是 人 类 模仿 生物 行为 的 杰出 例子 。 另 一 个 步行 机 
器 发 展 史 上 的 里 程 碑 是 机 器 马 ， 由 L. A. Rygg 于 1893 年 在 美国 专利 局 注册 ， 如 
图 1. 2 所 示 。 操 作者 通过 使 用 脚 踏 板 为 机 器 提供 动力 ， 利 用 连 杆 和 曲柄 产生 腿 的 
移动 。 这 一 度 被 认为 是 关于 腿 式 系统 的 第 一 个 专利 ， 但 不 清楚 它 是 否 实际 建成 。 

20 世纪 40 年 代 ， 研 究 人 员 和 工程 师 为 步行 机 器 人 开发 出 了 新 的 潜在 应 用 。 
军事 和 空间 领域 的 研究 人 员 被 足 式 运动 的 优势 所 吸引 ， 提 出 了 一 些 有 趣 的 研究 申 
请 ， 首 先是 在 英国 ， 然 后 是 在 美国 ， 作 为 战争 机 器 和 行星 探索 。 

第 一 个 具有 独立 控制 的 腿 和 适应 地 形 的 步行 机 器 ， 是 英国 人 在 1940 年 建造 
的 。A.C. Hutchinson 认为 ， 对 于 1000t 以 内 的 重型 车 辆 ， 腿 可 能 比 轮子 或 履带 
更 有 效率 。Hutchinson 与 F. S. Smith 合作 开发 能 够 水 平和 垂直 运动 解 耦 的 腿 部 


@ 术语 支撑 相 和 站 立 相 以 及 术语 转移 相 和 摆动 相 可 互 换 使 用 。 
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=0.2 0 0.2 0.4 0.6 0.8 
z/m 


(a) Chebyshev 机 器 支撑 轨迹 的 形状 〈 实 线 ) 和 摆动 轨迹 的 形状 〈 虚 线 ) 


(b) 通过 平面 图 获得 的 整个 机 器 的 草 绘图 (Artobolevsky, 1964) 
图 1.1 第 一 个 步行 机 器 
系统 ， 只 需要 有 两 个 液压 执行 机 构 就 可 以 移动 机 器 。 最 终 ， 他 们 建立 了 一 个 缩小 


尺寸 的 四 是 机 器 ， 高 60cm， 有 8 个 关节 ， 由 操作 员 线 控 来 实现 运动 。 该 机 器 是 
被 测试 用 于 装甲 车 辆 的 ， 但 当时 英国 深 陷 在 第 二 次 世界 大 战 中 ， 英 国 战 争 部 队 对 
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图 1.2 机 器 马 


这 些 事态 的 发 展 并 不 感 兴趣 ， 以 致 阻碍 了 机 器 的 进一步 发 展 (Todd, 1985). fF 
者 可 以 确定 ， 这 是 第 一 台 建 成 的 具有 地 形 适 应 性 的 四 足 机 器 。 

在 其 后 的 20 年 ， 基 于 美国 宇航 局 和 美国 陆军 的 资助 ， 美 国 进行 了 一 些 重要 
的 理论 研究 。 在 美国 陆军 坦克 汽车 公司 制造 中 心 ， 波兰 工程 师 M. G. Bekker 的 
发 现 特别 值得 注意 。 这 些 发 现 促 成 了 在 通用 电气 公司 合作 下 GE 步行 卡车 的 开 
发 。 这 个 四 足 工作 平台 机 体 长 3m， 重 量 1400kg， 由 R. S. Mosher 于 1962 年 开 
始 建造 ， 采 用 一 个 90 马力 8 汽油 发 动机 。 所 以 从 能 量 角度 看 ， 它 是 一 个 自主 机 
器 ; 但 是 由 坐 在 机 器 上 的 操作 员 执 行 腿 的 控制 。 操 作 员 通过 自己 的 手 和 脚 控制 手 
柄 和 踏板 ， 操 纵 机 器 所 有 的 12 个 关节 运动 。Todd (1985) 在 他 的 书 中 提 到 ， 负 
责 协 调 如 此 大 量 的 手柄 和 踏板 ， 操 作 员 无 法 控制 系统 超过 5min。 但 Raibert 
(1986) 声称 该 项 目的 主任 能 够 实现 在 大 约 20h 的 训练 后 顺畅 地 驾驶 车 辆 。 不 管 
怎样 ， 这 个 项 目 具 有 关键 作用 ， 它 激励 南 加 州 大 学 的 R. McGhee 扩大 研究 现 有 
的 运动 技术 。McGhee 看 到 了 GE 步行 卡车 在 20 世纪 60 年 代 中 期 的 演示 ， 认 识 
到 主要 问题 是 机 器 操作 者 无 法 协调 腿 部 运动 ， 即 使 是 在 短 时 间 内 。 他 当时 正在 与 
尔格 莱 德 大 学 R. Tomovic 合作 研究 有 限 状 态 控制 理论 ， 认 为 自动 循环 系统 可 以 
代替 操作 员 解 决 协调 腿 部 运动 的 问题 。 

大 概 在 同一 时 间 ， 美 国 宇 航 局 和 美军 再 次 装 助 探索 军事 运输 的 步行 机 器 人 、 


© 1 马力 =75kgf* m/s=735. 49875W 。 


部 分 “步行 测量 和 算法 


行星 探测 和 辅助 残疾 人 应 用 可 行 性 的 项 目 。 这 项 研究 的 一 个 重要 成 果 是 太空 总 公 
司 建造 的 Iron Mule Train. Iron Mule Train 是 一 个 八 足 机 器 人 ， 被 认为 是 步行 
机 器 发 展 史 上 的 另 一 个 里 程 碑 (Morrison，1968)。20 多 年 后 ，Tod (1991) 提 
出 基于 Iron Mule Train 的 一 些 轻微 修改 ， 有 助 于 使 部 件 更 容易 制造 。 他 的 结论 
是 : 修改 后 的 机 器 人 并 没有 在 技术 上 取得 进步 ， 但 是 提出 平衡 问题 对 于 机 器 人 的 
优点 的 局 限 至 关 重 要 。 

从 1966 年 到 1969 年 ，Bucyrus - Eire 公司 从 事 Big Muskie 的 建造 ， 是 至 今 
最 大 的 步行 机 器 。 它 重 13500t， 是 专门 在 露天 矿工 作 的 牵引 车 。 其 基于 四 足 液 压 
驱动 ， 足 围绕 固定 轴 旋 转向 前 移动 ， 而 机 器 的 机 体 停留 在 地 面 上 。 当 四 只 足 都 接 
触 地 面 时 ， 机 器 抬 起 并 移动 ， 转 到 新 的 放置 位 置 。 足 可 以 看 作 是 一 个 特定 半径 的 
车 轮 ， 机 器 速度 能 够 达到 270m/h, Big Muskie 被 认为 是 Hutchinson 想法 有 效 
的 证 据 ， 令 人 惊讶 的 是 ， 直 到 1991 年 它 还 可 以 运行 (Big Muskie, 2005). 

1966 年 ，McGhee 继续 他 的 研究 ， 并 与 A.A. Frank 一 起 建成 一 个 中 型 
(50kg) 的 四 足 机 器 人 “Phony Pony”， 如 图 1.3 所 示 。 每 条 腿 都 是 基于 带 旋转 
关节 的 两 自由 度 系统 ， 通 过 电动 机 驱动 。 足 是 倒 T 形 结构 ， 保 证 了 在 平面 上 的 
稳定 性 。 每 个 关节 都 安装 了 一 些 传感器 ， 用 于 检测 向 前 运动 或 向 后 运动 关节 是 和 否 
锁定 。 有 这 样 3 种 不 同 的 状态 ， 并 且 使 用 基于 触发 器 的 电子 逻辑 ， 他 们 创建 了 一 
个 具有 6 个 同步 状态 的 状态 机 。 机 器 人 通过 状态 图 选择 ， 执 行 四 足 的 候 行 和 对 角 
小 跑 运动 。 


图 1.3 “Phony Pony” 草 绘图 
“Phony Pony” 是 一 个 至 关 重 要 的 里 程 碑 ， 因 为 它 启发 McGhee (RA HIM 
WRF (OSU) 建立 了 新 的 步行 机 器 ， 并 成 为 步行 机 器 人 史上 的 重要 里 程 碑 ， 
BI OSU hexapod 和 Adaptive Suspension Vehicle (ASV), {I 1. 4 所 示 。 
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图 1.4 


OSU hexapod 建 于 


自 适应 悬 架 车 (ASV) (由 Waldron 提供 ) 


1977 年 ， 是 第 一 台电 脑 控制 的 步行 机 器 人 。 它 的 腿 基 于 


昆虫 腿 部 构 型 ， 具 有 3 个 电动 机 驱动 的 旋转 关节 。 这 个 机 器 人 成 为 一 个 大 型 的 实 


验 测试 平台 ， 产 生 众多 与 


j 步 态 生 成 、 机 器 人 控制 和 力 分 配 算法 相关 的 科学 成 果 。 


1986 年 ，McGhee 和 还 在 OSU 的 Waldron 一 起 测试 了 ASV hexapod， 其 可 能 是 
最 大 并 与 地 形 适 应 最 好 的 步行 机 器 人 (Waldron 和 McGhee, 1986; Song 和 


Waldron, 1989), 


1980 年 ,日 本 东京 工业 大 学 (TIT) W Hirose 开始 开发 大 型 家 用 四 足 步 行 


机 器 人 。 第 一 个 是 Pre- 


ambulate Vehicle (PV -[)， 如 图 1.5 所 示 ， 被 认为 是 


四 足 步行 机 器 人 发 展 的 重要 里 程 碑 ， 虽 然 在 它 之 前 还 有 一 个 名 为 KUMO 的 前 


Al 1. 


5 _PV-I 步 行 机 器 人 (由 Hirose 提供 ) 


身 。PV -I[ 重 10kg， 高 约 1m。 它 的 腿 是 基于 3 自由 度 的 比例 缩放 机 构 ， 作 为 
PANTOMEC 获得 专利 。 此 后 ， 该 结构 已 被 广泛 应 用 于 步行 机 器 人 的 建造 [图 
1.8 和 1.13 (a)]。 几 年 后 ，Hirose 开始 开发 TITAN 系列 ， 自 2001 年 以 来 ， 他 
一 直 在 研发 TITAN -区 (Kato 和 Hirose, 2001). 

1983 年 ，Odetics Incorporated 推出 了 ODEX 工 ， 一 个 六 足 机 器 人 ， 其 腿 部 
基于 比例 缩放 机 构 ， 并 且 放 置 在 圆 形 构架 中 〈Russell，1983)。 这 个 机 器 人 的 推 
出 并 没有 任何 重要 的 科学 贡献 ， 但 它 作为 第 一 个 商业 化 的 步行 机 器 人 ， 被 列 人 重 
要 成 果 。 该 公司 制作 了 一 个 升级 版 ， 用 于 检查 核电 厂 (Byrd 和 DeVries, 1990), 
之 后 该 公司 突然 停止 了 其 步行 机 器 人 的 研发 。 

到 目前 为 止 ， 提 到 的 所 有 步行 机 器 人 基本 上 是 静态 的 稳定 系统 。 第 一 个 有 完 
整 的 动态 稳定 性 的 奔跑 四 足 机 器 人 ， 由 M. Raibert (1986) 在 麻 省 理工 学 院 
(MIT) 建造 ， 如 图 1.6 所 示 。 大 部 分 参与 开发 动态 稳定 机 器 人 的 研究 人 员 一 开 
始 研究 步行 机 器 人 的 静态 稳定 ， 后 来 转向 研究 动态 系统 。Raibert 没有 这 样 做 ， 
而 是 成 功 地 解决 了 单 腿 问题 ， 并 将 他 的 研究 应 用 于 具有 2 个 、4 个 或 任何 数量 腿 
的 步行 机 器 。 


图 1.6 Raibert 动态 稳定 四 足 步 行 机 器 人 简 图 


对 于 步行 机 器 人 ， 步 态 行走 实现 高 速度 至 关 重 要 ， 这 是 获得 机 动 性 的 重要 途 
径 之 一 。 然 而 ， 对 于 步行 机 器 人 执行 的 大 多 数 任 务 ， 如 处 理 物 质 、 收 集 测量 等 ， 
其 必须 静止 或 以 非常 低 的 速度 行走 ， 因 此 又 需要 静态 稳定 的 步 态 。 

从 20 世纪 90 年 代 初 至 今 ， 世 界 各 地 正在 建造 的 步行 机 器 人 的 数量 大 幅 增 
加 。 超 过 200 种 不 同 的 机 器 人 已 经 编 人 目录 - (Berns，2005)， 其 中 约 20% 20 
足 机 器 人 ， 说 明 创造 四 足 步 行 机 器 人 有 发 展 前 景 。 稍 后 将 展示 其 特殊 的 性 能 。 


10 


BIR 步行 机 器 站 


表 1.1 总 结 了 多 足 机 器 人 发 展 的 历史 ， 突 出 了 四 足 步行 机 器 人 发 展 史上 的 重 
要 事件 。 值 得 注意 的 是 ， 自 1990 年 以 来 ， 步 行 机 器 发 展 的 真正 成 果 均 来 自 于 双 
足 机 器 人 。 


# 1.1 多 足 步 行 机 器 人 发 展 史 上 的 重要 事件 


研究 人 员 或 单位 重 要 事 件 
Chebyshev 四 连 杆 机 制 交替 支撑 相 和 摆动 相 


1961 Morrison Iron Mule Train 的 设计 和 测试 
1968 Frank #1 McGhee 设计 和 测试 了 “Phony pony” 
1968 Mosher 测试 GE 步行 卡车 


1969 Bucyrus — Erie Co. Big Muskie Big Muskie 13500t 重 步行 机 器 建成 ， 直 到 1991 年 还 在 运行 


1972 罗马 大 学 欧洲 第 一 个 步行 机 器 人 

1977 McGhee 测试 第 一 台电 脑 控制 步行 机 器 人 (OSU KE) 

1980 Hirose 和 Umetani PV -了 在 东京 技术 研究 所 开发 成 功 

1983 Odetics Inc. ODEX I 第 一 台 商 业 可 用 的 步行 机 器 人 E 


1987 Waldron 和 McGhee Bh ASV 演示 ， 迄今 建成 的 最 好 的 步行 机 器 人 
1989 Raibert 第 一 个 进行 四 足 小 跑 、 快 跑 和 束缚 步 态 控制 


1.2.2 步 态 设计 


在 创建 步行 机 器 后 ， 就 要 执行 腿 部 和 机 身 运 动 序列 使 机 器 步行 ， 这 个 序列 被 
称 为 步 态 。 步 态 已 经 研究 了 很 多 年 ， 然 而 长 期 以 来 ， 研 究 成 果 仅 在 非常 有 利 的 表 
面条 件 上 可 行 ， 即 平坦 和 水 平地 形 。 

M. Hildebrand (1965) 完成 了 与 四 足 步 态 相 关 的 第 一 个 重要 进展 。 他 描述 
和 比较 了 基于 物理 特征 和 性 能 的 特定 物种 的 四 足 步 态 ， 发 现 了 164 种 不 同 的 四 足 
步 态 。 他 定义 步 态 公式 的 概念 主要 基于 观察 和 直觉 ， 因 此 ， 他 的 工作 被 批评 缺乏 
科学 基础 。 后 来 ，McGhee 扩展 了 Hildebrand 的 想法 ,包括 步 幅 、 占 空 系数 和 
腿 部 相位 。 他 使 用 一 致 化 的 数学 公式 定义 了 这 些 参 数 (参见 第 3 章 参 数 定义 ) 。 

步 态 生 成 的 主要 事件 之 一 是 McGhee 和 Bessonov 的 研究 成 果 ， 他 们 分 别 研 
究 和 制定 了 连续 步 态 。McGhee 和 Frank (1968) 研究 了 四 足 步 态 ， 并 得 出 结 
W: 对 称 的 、 周 期 性 、 规 则 的 步 态 ， 称 为 波浪 步 态 ， 可 以 提供 四 足 最 佳 稳定 性 。 
几 年 后 ，Bessonov 和 Umnov (1973) 通过 数值 模拟 证 明 ， 波 浪 步 态 也 是 六 足 步 
行 机 器 的 最 佳 选择 。1982 Æ, Orin 研究 步 态 时 考虑 了 稳 行 角 ， 即 机 体 纵 轴 和 运 
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动 方向 形成 的 角度 (Orin，1982)。 此 后 ，Kumar 和 Waldron (1988) 得 出 改进 
的 波浪 步 态 ， 以 产生 六 足 连续 蟹 行 步 态 。 后 来 ，Zhang 和 Song (1990) 制定 了 
四 足 蟹 行 步 态 ， 人 允许 机 器 人 朝 任何 方向 移动 。 所 有 这 些 步 态 在 平坦 和 水 平地 形 都 
能 正确 执行 ， 但 还 不 能 在 不 规则 的 地 形 上 行走 。 

几 位 作者 采用 不 同 的 方法 研究 了 这 个 问题 。 主 流 方 法 是 使 用 传感器 进行 地 面 
检测 并 修改 一 些 已 知 算法 的 参数 ， 同 时 保持 一 些 其 他 参数 。Kumar 和 Waldron 
(1989) 提出 了 一 种 改进 的 波浪 步 态 ， 可 以 在 更 宽 的 速度 范围 内 自动 适应 所 选择 
的 立足 点 。 他 们 也 描述 了 基于 修改 步 态 参数 获得 所 需 速度 的 策略 。 一 般 来 说 ， 步 
态 是 通过 改变 其 占 空 因数 、 腿 部 相位 、 腿 部 步 幅 或 步 态 周 期 来 改变 。 还 有 一 些 作 
者 提出 了 一 种 步 态 控制 策略 ， 即 能 自动 适应 的 扔 行 步 态 ， 在 不 平坦 地 形 ， 当 步行 
机 器 执行 步 态 算法 时 可 以 实时 调整 步 态 参数 (Jimenez 和 Gonzalez deSantos, 
1997). 

还 有 一 种 步 态 称 为 不 连续 步 态 。 它 可 能 看 起 来 不 如 连续 步 态 ,但 实际 上 它 适 
应 不 规则 地 形 的 能 力 很 好 。 不 连续 步 态 与 波浪 步 态 有 很 多 相同 之 处 ， 即 它们 是 规 
则 的 、 对 称 的 和 周期 性 的 ， 并 且 与 波浪 步 态 的 生成 模式 相同 。 但 它们 的 机 体 运动 
方式 不 同 。 连 续 步 态 执行 腿 部 运动 的 同时 机 体 以 恒定 的 速度 移动 。 而 不 连续 步 态 
在 腿 全 部 着 地 时 推动 机 体 ， 在 机 体 静 止 和 其 他 腿 支 撑 时 ， 执行 一 条 腿 的 摆动 。 对 
于 某 些 占 地 系数 的 波浪 步 态 ， 这 种 步 态 提供 更 多 的 稳定 性 和 更 快 的 速度 ,本质 上 
提供 了 更 好 的 地 形 适 应 性 。 而 且 它 比 连续 步 态 易于 实现 ， 这 正 是 步行 机 器 所 必须 
具有 的 特征 。 

步 态 算法 的 另 一 个 问题 是 如 何 处 理 步 行 机 器 在 给 定 路 径 下 的 导航 。 可 以 使 用 
连续 步 态 和 不 连续 步 态 跟踪 策略 ， 使 用 机 体 参 考 坐 标 系 形成 蟹 行 角 ， 但 是 组 合 这 
些 直 线段 以 匹配 预定 义 轨迹 是 比较 麻烦 ， 特 别 是 使 用 连续 步 态 时 。 为 了 执行 运 
动 ， 周 期 步 态 被 构想 为 直线 蟹 行 步 态 ， 需 要 固定 在 机 体 参 考 坐 标 系 下 初始 足 的 位 
置 。 这 些 位 置 取决 于 蟹 行 角 ， 即 机 体 的 纵 轴 和 运动 方向 之 间 的 角度 。 因 此 ， 足 的 
位 置 必须 根据 其 他 足 的 运动 确定 ， 比 如 在 新 的 轨迹 开始 时 ,为 了 使 机 体 运 动 ， 必 
须 改变 腿 部 动作 以 适应 新 的 轨迹 。 值 得 注意 的 是 ， 这 对 于 四 足 步行 机 器 来 说 是 一 
项 艰巨 的 任务 ,但 是 对 六 足 蟹 行 步 态 ， 当 占 空 因数 为 0. 5 时 就 没有 这 些 问 题 ( 交 
蔡 三 角 支 撑 )。20 世纪 90 年 代 ， 几 位 作者 研究 了 四 足 步行 机 器 人 各 种 步 态 的 连 
接 方法 ， 提 出 一 些 算法 作为 寻找 步 态 周期 ， 连 接 两 个 蟹 行 步 态 的 辅助 手段 ， 而 某 
些 特征 则 保持 恒定 ， 如 速度 和 稳定 性 裕 度 (Lee 和 Song, 1990; Jimenez 和 
Gonzalez de Santos, 1997). 

另 一 个 要 考虑 的 重点 是 使 用 固定 支持 模式 推动 机 器 人 ， 阻 止 其 在 禁止 单元 区 
域 的 运动 ， 这 些 考虑 因素 推动 了 非 周期 步 态 的 研究 。 非 周期 步 态 也 称 为 自由 步 
态 ， 其 特征 在 于 实时 选择 腿 部 序列 和 足够 的 立足 点 。McGhee 和 Iswandhi 
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(1979) 为 六 足 步 行 机 器 人 设计 了 一 个 自由 步 态 ， 是 基于 Kugushev 和 Jaro- 
shevskij (1975) 以 前 开发 的 非 周期 性 算法 的 研究 。 该 方法 通过 选择 一 个 序列 的 
支撑 点 ， 使 步行 机 器 人 能 够 适应 不 适合 支撑 的 某 些 区 域 地 形 。 地 形 首 先 分 为 允许 
单元 和 禁止 单元 。 算 法 没有 考虑 地 形 的 不 规则 性 ， 仅 在 模拟 中 进行 测试 。 此 外 ， 
该 算法 旨 在 使 摆动 相 腿 部 数量 最 大 化 ， 因 此 ， 它 对 六 足 步 行 机 器 是 足够 的 ， 但 无 
法 证 明 对 于 四 足 步 行 机 器 人 非常 有 用 ， 因 无 法 使 四 足 机 器 多 于 一 条 腿 处 于 摆动 。 
几 年 后 ，Hirose (1984) 提出 了 一 种 专 为 四 足 机 器 人 而 设计 的 特别 的 自由 步 态 。 
进行 计算 机 模拟 测试 时 结果 很 好 。 虽 然 地 形 分 为 允许 单元 和 禁止 单元 ， 但 仍然 缺 
少 地 形 适应 功能 。 除 了 缺乏 地 形 适应 性 ， 自 由 步 态 对 路 径 跟踪 是 有 益 的 ， 因 为 它 
们 可 以 随时 改变 方向 。 - 

表 1.2 总 结 了 多 足 机 器 人 步 态 的 发 展 。 再 次 说 明 ， 自 1990 年 以 来 ， 步 行 机 
器 人 步 态 发 展 的 真正 成 果 一 直 来 自 双 足 机 器 人 。 


表 1.2 多 足 机 器 人 步 态 发 展 史上 的 重要 事件 
年 份 研究 人 员 重要 事件 
965 Hildebrand 动物 步 态 分 类 
968 McGhee 数学 步 态 公式 
1968 McGhee 和 Frank 四 足 最 佳 波浪 步 态 
973 Bessonov 和 Umnov 六 足 最 佳 波浪 步 态 
975 Kugushev 和 Jaroshevskij | 初步 制定 自由 步 态 
1979 McGhee 和 Iswandhi 完成 自由 步 态 构想 
989 Kumar 和 Waldron 适应 性 步 态 研究 
990 | 张 和 松 HERTSIA 
1.2.3 稳定 性 测量 


步行 机 器 人 的 主要 功能 是 提供 稳定 的 运动 ， 即 在 一 定 周期 的 运动 过 程 中 没有 
跌倒 。 步 行 机 器 人 的 稳定 性 是 一 个 二 进 制 概念 ， 步 行 机 器 人 是 稳定 的 或 不 稳定 
的 ， 没 有 中 间 状 态 。 但 是 ， 对 稳定 性 量化 是 很 有 必要 的 ， 即 机 器 人 距离 不 稳定 状 
态 的 程度 。 

1968 年 前 后 ，McGhee 和 Frank 首先 定义 了 稳定 性 的 概念 。 他 们 规定 ， 如 
果 步 行 机 器 人 其 重心 (COG) 的 水 平 投影 位 置 在 由 所 有 支撑 足 构成 的 支撑 多 边 
形 的 内 部 ， 则 步行 机 器 人 是 静态 稳定 的 。 作 为 稳定 性 测量 ， 他 们 计算 从 COG 投 
影 到 支撑 多 边 形 边界 的 最 短 距 离 ， 并 将 其 定义 为 稳定 容 度 (SSM) 。 因 此 ， 稳 定 
裕 度 短 ， 意 味 着 机 器 人 接近 不 稳定 。Zhang 和 Song (1989) H TEIT R} 
态 ， 并 定义 了 这 个 步 态 的 稳定 裕 度 。 为 了 简化 公式 ， 他 们 定义 了 纵向 稳定 裕 度 
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(SLSM), ， 即 在 机 器 人 纵 轴 的 方向 ， 从 COG 到 支撑 多 边 形 边界 的 最 短 距离。 

对 于 基于 COG 投影 的 稳定 性 测量 ，COG 的 高 度 不 是 影响 因素 。 本 质 上 
COG 似乎 越 高 ， 越 不 稳定 。 当 机 器 人 站 在 斜坡 上 时 ，COG 的 位 置 特别 重要 。 
SLSM 并 不 取决 于 地 形 的 倾斜 度 ， 但 比 起 上 坡 机 器 人 更 容易 在 下 坡 倾倒 。 为 了 解 
决 这 个 问题 ，Messuri 提出 了 一 个 新 的 测量 参数 ， 称 为 能 量 稳定 裕 度 (SESM) 
(Messuri, 1985; Messuri 和 Klein，1985) 。 该 参数 被 定义 为 步行 机 器 人 克服 围 
绕 支 撑 多 边 形 的 边 翻 转 的 最 小 势能 。 这 个 能 量 取 决 于 机 器 人 的 重量 。1998 年 ， 
Hirose 及 其 同事 对 机 器 人 重量 进行 归 一 化 测量 ， 并 定义 归 一 化 能 量 稳定 裕 度 
(SNESM) (Hirose 等 ，1998) 。 

SESM 和 SNESM 是 步行 机 器 人 翻转 所 需 的 外 部 冲击 能 量 。 但 是 仍然 使 用 静 
态 测 量 ， 因 为 不 包括 机 器 人 在 撞击 之 前 的 惯性 力 。 当 步行 机 器 人 以 中 等 速度 移动 
时 ， 可 能 会 发 生动 态 效 应 ， 从 而 改变 翻滚 所 需 的 总 能 量 。 当 步行 机 器 人 携带 机 器 
手 时 就 可 能 发 生 上 述 情 况 。 因 此 至 少 在 这 种 情况 下 ， 应 该 采取 动态 测量 。 

Orin 第 一 个 尝试 定义 动态 测量 (1976) 。 他 将 动态 稳定 裕 度 (SDSM) 定义 
为 压力 中 心 (COP) 到 支撑 多 边 形 边界 的 最 短 距 离 。COP 定义 为 COG 沿 着 作用 
在 质心 的 所 有 力 的 合力 的 投影 。 因 此 ， 在 静态 条 件 下 COP 与 COG 一 致 ， 即 它 
也 不 考虑 机 体高 度 。 

在 过 去 10 年 中 ， 一些 研究 人 员 试 图 定义 能 够 计算 动态 效应 影响 的 稳定 性 裕 
度 。 虽 然 是 基于 不 同 标准 ， 但 最 终 均 得 出 了 非常 相似 的 定义 。 稳 定性 测量 发 展 史 
上 的 重要 事件 见 表 1.3， 并 将 在 第 2 章 展 开 。 


表 1.3 稳定 性 测量 发 展 史上 的 重要 事件 
年 份 研究 人 员 重要 事件 
1968 McGhee 和 Frank 静态 稳定 性 定义 、 稳 定 裕 度 
1976 Orin 动态 稳定 裕 度 
1985 - Messuri 能 量 稳定 裕 度 
1989 Zhang 和 Song 纵向 稳定 裕 度 
1998 Hirose 及 其 同事 归 一 化 能 量 稳定 裕 度 


1.3 步 态 运动 的 优点 


除了 创造 机 器 来 模仿 自然 运动 ， 有 些 研 究 人 员 还 想 利 用 步 态 运动 相对 于 
传统 车 辆 一 一 轮 式 或 履带 车 辆 的 优点 ， 用 于 工业 或 服务 业 。 下 面 讨 论 这 些 
优点 。 
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第 1 章 步行 机 器 人 


步行 机 器 人 比 轮 式 机 器 人 表现 出 更 好 的 机 动 性 ， 因 为 它们 本 质 上 是 全 方位 的 
系统 。 也 就 是 说 ， 一 个 步行 机 器 人 只 通过 改变 立足 点 位 置 就 可 以 独立 于 主体 轴 的 
方向 而 改变 方向 ， 而 传统 的 轮 式 机 器 人 还 需要 被 操纵 来 改变 方向 。 

同样 ， 步 行 机 器 人 在 保持 立足 点 时 ， 只 需要 改变 腿 部 伸展 量 就 可 以 移动 和 改 
变 机 身 方向 。 此 功能 为 机 体 提 供 6 个 额外 的 自由 度 (DOF)。 图 1.7 说 明了 这 些 
特征 ， 腿 部 机 构 是 基于 3 自由 度 的 。 需 要 说 明 的 是 ， 具 有 牵引 力 的 轮子 和 安装 转 
向 电机 的 轮 式 机 器 人 也 可 以 大 大 提高 其 方向 性 ， 但 成 本 也 会 随 之 增加 ， 系 统 会 更 
加 复杂 。 使 用 特殊 功能 轮子 的 机 器 人 ， 如 Ilonator 轮 , -能 够 全 方位 运动 ， 但 是 只 
能 在 平面 上 使 用 (Ilon，1975) 。 


1.3.2 克服 障碍 


步行 机 器 人 只 要 能 够 踩 在 障碍 物 上 ， 就 可 以 克服 比 最 大 离 地 间隙 稍 低 的 障碍 
物 。 但 轮 式 机 器 人 只 能 克服 不 到 车 轮 半 径 一 半 的 障碍 物 (McKerrow，1991)。 
履带 车 辆 可 以 当 作 以 履带 长 度 一 半 为 车 轮 半 径 的 车 轮机 器 人 ， 所 以 履带 车 辆 可 以 
比 轮 式 机 器 人 克服 更 高 的 障碍 物 ， 但 需要 较 大 的 机 体 运动 。 


1.3.3 EJER 


步行 机 器 人 通过 调整 腿 部 长 度 来 适应 地 形 的 不 规则 ， 从 而 提供 内 在 的 主动 悬 
架 。 从 而 使 步行 机 器 人 通过 高 度 不 规则 的 地 形 并 能 够 保持 机 体 水 平 。 因 此 ， 步 行 
系统 运动 时 可 使 驾驶 员 感 觉 平 稳 舒 适 。 相 比 之 下 ， 轮 式 机 器 人 的 机 体 总 是 平行 于 
地 面 ， 即 保持 与 地 面相 同 的 倾角 。 


1.3.4 能 量 效率 


Hutchinson 在 1940 年 提出 ， 对 于 非常 重 的 车 辆 ， 步 行 机 器 人 可 能 比 轮 式 机 
器 人 能 量 效率 更 高 。 后 来 ，Bekker 通过 实验 证 明了 Hutchinson 的 说 法 ， 在 非常 
不 规则 的 地 形 条 件 下 ， 步 行 系统 比 轮 式 或 履带 系统 更 有 效率 。 表 1.4 显示 了 
Bekker 在 车 辆 和 动物 的 比较 研究 中 获得 的 数据 (1960)。 


表 1.4 Bekker 对 车 辆 和 动物 的 研究 


研究 对 象 “| 高度 不 规则 地 形 的 平均 速度 /(km. ho!) | 在 25cm 厚 塑料 条 上 移动 所 需 动力 /( 马 力 . {7!) 
履带 式 车 辆 | 8~16 
轮 式 机 器 人 5 一 8 | 15 
动物 >50 a 


部 分 “步行 测量 和 算法 


1.3.5 自然 地 形 


轮 式 机 器 人 需要 在 非常 昂贵 的 、 连 续 铺 设 的 表面 才能 有 效 移动 。 原 则 上 ， 步 
行 系统 不 需要 像 轮 式 机 器 人 那样 在 预 设 的 地 形 上 ， 而 可 以 在 沙滩 、 泥 池 、 硬 质 和 
松软 地 形 以 相近 的 效率 移动 。 步 行 系统 的 另 一 个 优点 是 不 需要 连续 的 地 形 来 
移动 。 

1.3.6 滑动 和 干扰 


车 轮 在 柔软 的 地 形容 易 下 沉 ， 造 成 轮 式 机 器 人 移动 困难 。 然 而 ， 如 果 步 行 机 
器 人 的 一 条 腿 垂直 放置 在 地 面 上 ， 只 能 在 同一 个 方向 压缩 软 地 面 。 腿 部 提升 是 垂 
直 执 行 的 ， 与 地 面 无 关 。 当 推进 机 体 时 ， 足 围绕 它们 的 关节 旋转 ， 而 腿 不 与 地 面 
相互 作用 ， 因 此 不 会 造成 任何 干扰 问题 。 车 辆 向 前 或 向 后 滑动 时 也 是 如 此 。 


1.3.7 环境 破坏 


步行 机 器 人 与 地 面 的 接触 点 是 离散 的 ， 而 轮 式 或 履带 车 辆 沿 着 地 面 使 用 两 条 
连续 路 径 。 因 此 ， 步 行 机 器 人 接触 地 面 更 少 ， 从 而 减少 环境 破坏 。 


1.3.8 平均 速度 


传统 的 车 辆 可 以 在 预 设 的 路 面 上 以 高 速 移 动 。 但 是 ， 当 地 形 不 平坦 时 ， 车 速 
迅速 下 降 。 有 腿 的 移动 系统 〈 例 如 哺乳 动物 ) 能 够 很 好 地 适应 不 规则 地 形 ， 能 够 在 
各 种 地 形 保持 相似 的 平均 速度 ，Bekker 的 研究 证 明了 这 一 现象 ， 如 图 1.7 所 示 。 


L4 步 态 运动 的 缺点 


当然 ， 步 行 机 器 不 是 移动 的 通用 解决 方案 ， 对 于 工业 和 服务 业 ， 其 也 有 不 被 
使 用 的 问题 和 缺点 。 第 一 个 问题 是 复杂 性 。 步 行 机 器 人 比 轮 式 机 器 人 更 复杂 ， 包 
括 机 械 方面 、 电 子 系统 和 控制 等 方面 。 另 一 个 问题 是 步行 机 器 人 的 速度 。 静 态 稳 
定 的 步行 机 器 人 移动 速度 非常 慢 。 动 态 稳定 的 步行 机 器 人 仍 处 于 发 展 的 初期 阶 
段 ， 似 乎 也 没有 轮 式 机 器 人 快 。 第 3 个 问题 是 成 本 。 这 些 问 题 下 面 进一步 探讨 。 


1.4.1 机 械 系统 


车 轮 是 非常 简单 的 机 构 ， 由 一 个 旋转 关节 组 成 。 一 条 腿 由 几 个 连 杆 和 关节 
《旋转 副 或 棱 形 副 ) 组 成 ， 这 个 系统 显然 比 简单 的 车 轮 更 复杂 。 一 个 车 轮 只 需要 
一 个 致 动 器 来 驱动 它 ， 另 一 个 致 动 器 驱动 它 转 向 。 最 简单 的 静态 稳定 轮 式 车 辆 是 
三 轮 车 ， 由 牵引 车 轮 和 转向 车 轮 〈 两 个 致 动 器 ) 组 成 ， 还 有 两 个 或 更 多 被 动车 
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机 动 性 


克服 障碍 


主动 悬 架 


自然 地 形 
( 非 连 续 地 形 ) 


滑行 和 干扰 


环境 破坏 


平均 速度 


图 1.7 步行 机 器 人 与 轮 式 机 器 人 对 比 图 


轮 。 其 他 轮 式 车 辆 配置 ， 如 差 速 系统 ， 或 最 新 的 自 平 衡 双 轮 车 辆 CTirmant 等 ， 
2002)， 也 只 需要 几 个 致 动 器 。 最 复杂 的 系统 有 4 个 车 轮 ， 具 有 独立 牵引 和 转向 
致 动 器 ， 总 共 8 个 。 而 一 条 腿 需 要 至 少 3 个 自由 度 ， 这 意味 着 需要 3 个 自由 度 致 
动 器 提供 牵引 力 和 转向 。 静 态 步 行 机 器 人 至 少 需要 4 条 腿 ， 因 此 ， 用 于 步行 机 器 
人 的 致 动 器 的 数量 必须 至 少 为 12 个 。 因 此 步行 机 器 人 对 于 轮 式 机 器 人 而 言 机 电 
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系统 更 复杂 ， 也 更 昂贵 。 


1.4.2 电子 系统 


每 个 致 动 器 都 有 相关 的 电源 驱动 器 ， 因 此 步行 机 器 人 比 轮 式 机 器 人 需要 更 多 
的 电子 系统 。 步 行 机 器 人 的 关节 必须 控制 ， 因 此 控制 系统 需要 传感器 。 而 且 步行 
机 器 人 需要 比 传统 车 辆 更 多 的 传 感 咒 ， 进 而 会 导致 更 多 问题 。 

车 轮 总 是 与 地 面 接触 ， 而 腿 的 支撑 相 和 摆动 相交 蔡 进 行 ， 因 此 需要 传感器 来 
确定 足 是 否 接触 地 面 。 每 条 腿 增加 了 传感器 的 数量 ， 包 括 触摸 传感器 ， 或 某 种 类 
似 的 传感器 ， 同 时 增加 了 处 理 传感器 信息 所 需 的 电子 必 片 的 数量 。 

用 于 控制 步行 机 器 人 的 算法 比 用 于 移动 轮 式 机 器 人 的 算法 更 复杂 ， 但 还 没有 造 
成 很 大 的 计算 负担 ， 机 器 人 也 没有 特殊 的 计算 要 求 ， 两 种 机 器 人 的 计算 系统 很 相似 。 


1.4.3 控制 算法 


轮 式 驱动 器 或 用 于 轮 式 机 器 人 的 转向 驱动 器 仅 需要 控制 器 的 信号 。 通 常 这 个 
电压 值 与 所 需 的 速度 或 所 需 的 转向 角度 成 比例 。 然 而 ， 四 足 机 器 人 必须 同时 协调 
所 有 12 个 关节 的 运动 以 及 足 传 感 器 ， 以 提供 稳定 的 运动 。 因 此 步行 机 器 人 的 控 
制 算法 比 轮 式 机 器 人 更 复杂 。 


1.4.4 可 达 速 度 


与 轮 式 机 器 人 相 比 ， 步 行 机 器 人 在 非常 不 规则 的 地 形 可 以 实现 更 高 的 速度 。 
在 预 设 的 良好 表面 上 如 道路 、 街 道 和 工厂 的 地 板 上 ， 轮 式 机 器 人 的 速度 一 定 更 
快 。 例 如 ， 马 或 猎豹 的 奔跑 速度 高 达 60 一 80km/h， 而 轮 式 机 器 人 的 速度 可 达 
350km/h。 步 行 机 器 人 无 法 与 这 些 动物 和 车 轮机 器 人 竞争 ， 但 并 不 是 它们 将 来 没 
有 能 力 。 


1.4.5 成 本 


系统 的 总 成 本 与 其 复杂 性 成 正比 ， 包 括 机 器 、 电 子 、 传 感 器 等 。 因 此 ， 步 行 
机 器 人 的 成 本 比 轮 式 机 器 人 高 得 多 。 表 1. 5 给 出 了 一 些 关 于 四 足 机 器 人 和 最 简单 


的 轮 式 机 器 人 的 复杂 性 对 比 ， 用 于 比较 和 费用 估算 。 
表 1.5 双 致 动 器 轮 式 机 器 人 和 四 足 机 器 人 的 复杂 性 对 比 
设 备 |[ 轮 式 机 器 人 /个 | 四 足 机 器 人 /个 | wv 备 | 轮 式 机 器 人 /个 | 四 足 机 器 人 /个 
致 动 器 2 12 | 关节 传感器 | 2 | 12 
驱动 器 2 | 12 | 车 轮 / 足 传感器 | 0 | 4 
控制 器 2 12 计算 机 1 1 
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总 之 ， 步 行 机 器 人 在 预 设 的 地 面 上 不 会 完全 替代 传统 车 辆 。 步 行 机 器 人 与 传 
统 车 辆 相 比 具有 明显 优势 的 唯一 适用 用 途 是 自然 地 形 、 高 度 不 规则 的 地 形 、 特 殊 
的 几何 结构 如 楼 梯 等 。 


1.5 步行 机 器 人 的 潜在 用 途 和 实际 用 途 


步行 机 器 人 的 潜在 用 途 是 基于 其 执行 特定 任务 时 相 比 轮 式 或 履带 车 辆 的 优 
势 。 因 此 ， 在 传统 的 车 辆 应 用 中 ， 使 用 步行 机 器 人 更 有 优势 ， 如 军事 任务 ， 复 杂 
或 危险 情况 的 检查 ， 陆 地 、 水 下 和 空间 探测 ， 林 业 和 农业 任务 ， 建 筑 活动 和 民用 
工程 等 。 还 可 以 使 用 步行 机 器 人 作为 研究 活体 动物 行为 的 实验 台 进行 试验 ， 并 用 
于 测试 人 工 智 能 CAD 技术 。 步 行 机 器 人 也 用 于 社会 活动 ， 包 括 扫雷 和 排除 炸 
弹 等 人 道 主 义 援助 。 

以 下 简要 讨论 一 些 潜 在 应 用 ， 表 1.6 总 结 了 一 些 特定 应 用 的 步行 机 器 人 。 

表 1.6 特定 应 用 的 步行 机 器 人 (Berns, 2005) 


应 用 


机 器 人 


GE 步行 卡车 


帮助 残障 人 士 


Walking chair 


军事 应 用 Iron Mule Train Attila 

ASV AIBO 

ODEX I 支撑 AI 技术 TUM 

核电 站 检测 Sherpa TARRY 
RIMHO 


SILO4 


ReCus 
Palaiomation 
AMBLER 生物 学 研究 
陆地 、 水 下 和 空间 探测 e Butch 
ante 
Aquarobot TITAN V-I 
林业 和 农业 任务 Timberjack AMRU -2 
建筑 活动 ROWER 人 道 主义 排 雷 COMET 
TITAN W Ariel 
民用 工程 


15.1 军事 应 用 


ROBOCLIMBER 


SILO6 


军事 运输 活动 需要 车 辆 适应 大 多 数 地 形 ， 如 不 规则 、 倾 斜 、 沙 质 、 泥 洗 、 铺 


路 等 。 这 些 车 辆 还 必须 克服 诸如 沟 歼 和 反 坦 克 障 碍 物 等 障碍 。 正 如 前 面 章节 中 提 
到 的 ， 步 行 机 器 人 在 理论 上 能 够 通过 这 些 地形 和 障碍 物 。 因 此 ， 在 军事 机 构 的 支 
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分 ”步行 测量 和 算法 


持 下 ， 研 究 人 员 一 直 在 尝试 建立 步行 机 器 人 ， 包 括 由 Hutchinson 开发 原型 、 由 
英国 战争 部 赞助 的 Iron Mule Train 以 及 由 美国 陆军 和 国防 高 级 研究 部 门 资助 项 
目 局 (DARPA) 全 额 资助 的 ASV. 


1.5.2 核电 厂 检 测 


步行 机 器 人 的 另 一 个 可 能 用 途 是 操作 和 检查 核电 站 。 核 电站 存在 轮 式 机 右 人 
无 法 通过 的 地 区 (地板 上 的 管道 、 楼 梯 等 )， 通 过 步行 机 器 人 更 加 容易 应 对 。 

如 前 所 述 ，Odetics Inc. 建立 了 ODEX 工 步行 机 器 人 的 工业 版 本 ， 专 门 设计 
在 这 种 环境 中 工作 (Byrd 和 DeVries，1990) 。 一 个 西班牙 财团 建造 了 RIMHO 
四 足 机 器 人 ， 测 试 这 种 机 器 人 在 核 环 境 中 的 可 能 用 途 ， 如 图 1.8 所 示 (Jimenez 
等 ，1993) 。 在 欧洲 ，Sherpa 机 器 人 “法国 原子 能 委员 会 ) 是 再 一 次 尝试 开发 六 
足 机 器 人 用 于 核 环境 的 例子 (Berns，2005) 。 


图 1.8 RIMHO 步行 机 器 人 


1.5.3 陆地 、 水 下 和 空间 探测 


步行 机 器 人 具有 适应 不 同 未 知 类 型 地 形 的 能 力 ， 能 够 克服 障碍 ， 以 离散 的 接 
触 点 接触 地 面 ， 这 些 都 使 其 成 为 陆地 、 水 下 和 空间 探测 的 完美 候选 人 。 目 前 已 经 
专门 制造 和 测试 了 一 些 机 器 人 用 于 这 些 用 途 。 

(1) 由 美国 宇航 局 资助 ， 卡 内 基 梅 隆 大 学 开发 的 AMBLER 作为 实验 测试 平 
台 ， 用 于 开发 对 火星 进行 假设 任务 所 需 的 技术 (Bares 和 Whittaker, 1989 和 
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1993). 

(2) Dante 4 AMBLER —#, HleI—TF EDA E, E — TOL, 
用 于 阿拉 斯 加 山脉 火山 火山 口 的 内 部 检查 (Bares 和 Wettergreen, 1999). 

(3) Aquarobot 在 日 本 港口 研究 所 实验 室 构 建 ， 用 于 海底 水 下 测量 (Akizono 
等 ，1989)。 

值得 注意 的 是 ， 传 统 车 辆 不 能 到 达 世 界 上 超过 50% 的 土地 (Bihari 等 ， 
1989)， 因 此 必须 使 用 动物 或 步行 机 器 人 进行 探索 。 


1.5.4 林业 和 农业 任务 


步行 机 器 人 能 够 在 森林 里 移动 并 砍 倒 树 木 是 非常 有 用 的 。 在 这 种 情况 下 ， 树 
干 本身 就 是 自然 障碍 ， 和 森林 地 形 通 常 是 倾斜 的 或 多 山 的 。 步 行 机 器 人 可 以 通过 调 
整 机 体 保持 在 这 种 地 形 的 稳定 性 。 轮 式 机 器 人 没有 这 种 能 力 ， 它 们 很 容易 在 这 种 
地 形 下 翻 深 。Plustech Oy 是 John Deere 建筑 和 林业 公司 的 分 公司 , 已 经 开发 出 
了 一 种 用 于 这 类 地 形 ， 名 为 Timberjack 的 步行 机 器 。Timberjack 是 一 个 六 足 机 
怖 人 ， 类 似 农业 拖拉 机 ， 并 携带 机 械 手 来 处 理工 具 或 夹具 。 作 者 强烈 推荐 观看 这 
个 步行 机 器 人 的 视频 (Plustech - Oy, 2005). 

类 似 的 机 器 人 对 于 农业 任务 也 非常 有 用 ， 因 为 它 可 以 通过 简单 的 离散 接触 点 
来 移动 ， 从 而 保护 农作物 。 而 类 似 的 轮 式 机 器 人 或 履带 机 器 人 沿 着 通过 路 径 会 破 
坏 农 作物 。 


1.5.5 建筑 活动 


建筑 领域 是 步行 机 器 人 的 重要 应 用 ， 特 别 是 在 复杂 环境 中 与 运动 有 关 时 。 例 
如 ， 在 造船 过 程 中 ， 在 干 船坞 需要 将 所 有 分 块 船体 连接 ， 将 所 有 纵向 和 垂直 加 强 
筋 焊 接 在 舱 壁 上 。 图 1. 9 显示 了 一 个 典型 的 场景 ， 周 围 是 10mX4mX3m 左右 闭 
孔 的 ， 传 统 上 是 通过 手 进 行 焊接 。 

为 了 通过 增加 总 电弧 时 间 提 高 生产 率 、 改 善 焊 接 质量 、 改 善 操作 员 的 工作 条 
件 ， 一些 造船 厂 和 研究 人 员 根 据 欧 洲 共 同体 委员 会 ECC) 的 赞助 ， 设 计 和 建造 
了 自动 焊接 系统 (1994 一 1998 年 )。 : 

整个 系统 由 具有 商业 焊接 系统 的 移动 平台 和 操作 焊接 系统 的 机 器 人 组 成 。 四 
足 机 器 人 被 认为 是 首选 。 它 的 腿 基于 SCARA 结构 ， 因 为 没有 曲柄 摇 杆 ， 因 此 腿 
和 加 强 筋 之 间 不 会 出 现 碰撞 。 但 是 ， 这 个 结构 的 问题 是 为 将 操纵 器 靠近 舱 壁 的 顶 
部 垂直 连 杆 很 长 (2m) 。 这 么 长 的 连 杆 携带 重 载荷 〈 约 130kg) 后 容易 造成 垂直 
连 杆 弯曲 和 振动 ， 特 别 是 机 体位 于 其 最 高 位 置 时 。 连 杆 长 也 会 影响 机 器 的 静态 稳 
定性 。 因 此 ， 提 出 了 一 种 称 为 ROWER 的 改进 结构 来 解决 这 个 问题 ， 使 它 能 够 
通过 抓 住 扶手 来 行走 。 
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图 1.9 ROWER 步行 机 器 人 


图 1.9 中 ，ROWER 步行 机 器 人 在 一 个 单元 内 ， 四 条 腿 全 部 抓 住 扶手 。 在 这 
个 位 置 上 ， 机 体 可 以 向 前 、 向 后 、 向 上 、 向 下 和 侧 向 移动 。 机 天 人 沿 着 单元 的 运 
动 是 通过 依次 移动 腿 和 机 体 来 实现 的 ， 四 条 腿 抓 住 扶手 执行 机 体 动作 。 腿 的 动作 
和 握 持 程序 在 Gonzalez de Santos 等 (2000) 的 文章 中 进行 了 详细 描述 。 这 是 使 
用 步行 机 器 人 在 特殊 结构 上 行走 的 例子 。 


1.5.6 民用 工程 


在 民用 建筑 领域 ， 需 要 一 种 在 不 平坦 地 形 和 和 斜坡 上 移动 的 专用 装置 。 道 路 施 
工时 ， 需 要 经 常 在 斜坡 上 的 运动 。 在 地 面 插入 钢筋 并 用 金属 网 覆盖 ， 以 避免 土壤 
滑动 和 石头 滚动 。 这 项 工作 由 操作 员 操 纵 带 工具 的 装置 执行 ， 这 个 装置 通过 连接 
到 斜坡 上 部 的 电缆 连接 并 拖 动 。 为 了 使 这 个 装置 在 斜坡 上 下 移动 ，Hirose 教授 
Æ TIT HÈT TITAN 步行 机 器 人 (图 1. 10)， 它 们 也 采用 类 似 的 电缆 连接 ， 
使 用 其 腿 部 适应 不 规则 地 形 (Hirose 等 ，1997)。ECC 资助 的 欧洲 研究 组 织 最 近 
开发 了 类 似 的 系统 (Nabulsi 和 Armada, 2004), 


1.5.7 帮助 残障 人 士 


步行 机 器 人 必 将 改善 残障 人 士 的 生活 。 虽 然 为 残障 人 士 创 造 便 利 有 很 大 的 社 
会 动机 ， 但 克服 带 楼 梯 等 的 建筑 物 障 碍 和 不 平坦 的 乡村 地 形 是 个 难题 。 步 行 机 器 
人 可 以 移动 残障 人 士 克 服 这 些 障碍 物 。 来 自 美国 伊利 诺 伊 州 大 学 芝加哥 分 校 的 一 
个 研究 小 组 在 20 世纪 90 年 代 末 试图 创造 这 样 一 台 机 器 ， 但 没有 最 终 的 结果 报告 
(Zhang 和 Song，1989)。 因 为 作者 面 对 潜在 用 户 时 遇 到 了 诸如 机 器 价格 或 维护 
设备 成 本 的 问题 。 对 此 ， 政 治 家 和 研究 人 员 应 该 共同 努力 来 攻克 难题 。 
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图 1.10 民用 项 目的 步行 机 器 人 TITAN M 
(照片 由 Hirose 教授 提供 ) 


1.5.8 支撑 AI 技术 


几 年 前 ， 对 机 械 操纵 臂 进行 大 量 的 人 工 智 能 (AD WA, 实际 上 AI 测试 对 
于 移动 机 器 人 开发 也 非常 重要 。 一 些 研究 人 员 相 信和 运动 产生 智能 (Moravec, 
1988) ， 运 动 使 我 们 学 会 学 习 和 决定 。 自 然 地 ， 可 移动 设备 比 机 械 操纵 臂 有 更 多 
的 学 习 机 会 。 步 行 机 器 人 与 可 移动 设备 有 相同 的 问题 ， 包 括 与 步 态 生 成 相关 的 问 
题 。 因 此 ， 许 多 AI 研究 人 员 使 用 步行 机 器 人 测试 他 们 的 理论 和 方法 。 例 如 ， 
Brooks 建立 了 名 为 Attila 的 步行 机 器 人 (Angle 和 Brooks，1990)。 由 索尼 公司 
设计 的 AIBO, 已 被 许多 研究 团体 使 用 ， 主 要 用 于 测试 AI 和 传感器 集成 技术 
(Fujita，2001)。 由 西班牙 工业 自动 化 研究 所 AAI- CSIC 开发 的 SILO4 步行 
机 器 人 是 另 一 个 例子 ， 计 划 为 有 兴趣 开发 AI、 传 感 器 集成 或 步 态 生成 技术 的 研 
究 人 员 进 行 测试 (Gonzalez、Santos 等 ，2003)， 如 图 1.11 所 示 。SILO4 机 器 人 
常 作为 用 于 比较 研究 的 实验 平台 ， 其 开发 人 员 已 经 开始 鼓励 研究 人 员 使 用 互联 网 
上 可 用 的 图 纸 和 指示 建立 自己 的 原型 CSILO4, 2005). 
1.5.9 生物 学 研究 

在 过 去 20 年 中 ， 动 物 学 家 和 生物 学 家 对 生物 行走 进行 了 大 量 研 究 。 某 些 研 
究 人 员 得 出 结论 : 一 些 简单 的 规则 就 可 以 定义 一 个 稳 态 运动 序列 (Cruse 等 ， 


1998) 。 这 些 规 则 可 以 通过 仿真 来 验证 ， 但 是 对 研究 人 员 来 说 ， 应 用 于 真正 的 模 
仿 昆 虫 行为 的 机 器 人 更 加 重要 。 因 此 ，TUM (Pfeiffer 和 Weidemann, 1991) 
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图 1.11 SILO4 步行 机 器 人 


或 Tarry (Frik 等 ，1999) 就 是 模仿 棒 虫 的 腿 部 结构 建立 的 机 器 人 。 还 可 以 研 
发 一 些 机 器 人 用 于 模仿 灭绝 物种 ， 这 对 于 教育 和 娱乐 很 有 好 处 。 例 如 ， 由 欧 共 
体 在 1994 年 资助 的 PALAIOMATION 项 目 开 发 的 机 器 人 模仿 禽 龙 (实际 尺寸 
的 1/4) (图 1.12)， 还 有 称 为 Butch 的 新 型 dino- robot， 类 似 于 角 龙 (Butch, 
2005) 。 


图 1.12 PALAIOMATION 项 目的 原型 
(经 Papantoniou 博士 许可 转载 ) 
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1.5.10 ”人道 主义 排 雷 


检测 和 清除 地 雷 是 一 个 世界 问题 。 过 去 20 年 部 署 了 大 量 地 雷 ， 即 使 未 来 没 
有 部 署 更 多 地 雷 ， 排 雷 也 需要 几 十 年 。 使 用 新 技术 可 以 实现 高 排 雷 率 ， 如 改进 的 
传感器 、 高 效 的 操纵 器 和 移动 机 器 人 等 。 任 何 车 辆 理论 上 都 可 以 在 雷 场 上 携带 传 
感 器 ， 但 步行 机 器 人 更 有 优势 。 

步行 机 器 人 排 雷 的 技术 一 直 在 发 展 ， 有 的 原型 已 经 经 过 测试 。TIT 开发 
TITAN 出 是 其 中 第 一 个 用 于 排 雷 任务 的 步行 机 器 人 (Hirose 和 Kato, 1998). 
由 布鲁塞尔 Free 大 学 和 比利时 皇家 军事 学 院 开发 的 电 驱 气动 六 足 机 器 人 AMRU -2 
(Baudoin 等 ，1999) 和 在 IAI- CSIC 开发 的 RIMHO2 [图 1.13 (a)] 也 是 用 于 
测试 人 道 主 义 扫雷 任务 的 步行 机 器 人 。 


ie 
(b) SILO6 


图 1.13 人 道 主 义 扫雷 机 器 人 
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COMET -1 可 能 是 第 一 个 专门 开发 的 执行 扫雷 任务 的 步行 机 器 人 。 它 是 由 
日 本 研究 团体 开发 的 六 足 机 器 人 ， 并 结合 了 不 同 的 传感器 和 征 位 系统 (Nonami 
等 ，2000) 。COMET 研究 团体 正在 开发 这 个 机 器 人 的 第 3 个 版 本 。ARIEL 是 由 
IRobot 公司 开发 的 另 一 种 六 足 机 器 人 ， 用 于 矿山 开采 作业 。DARPA 和 美国 海 
军 办 事 处 正在 研究 将 该 机 器 人 用 于 执行 水 下 任务 的 方法 (Voth, 2002). 

针对 人 道 主义 扫雷 这 一 特定 任务 ，IAI -CSIC 创建 了 DYLEMA (西班牙 语 
首 字 母 缩写 ， 即 杀伤 地 雷 的 有 效 检 测 和 定位 ) 地雷 检测 和 定位 系统 。 它 是 基于 
SILO6 步行 机 器 人 ， 并 携带 一 个 检测 装置 [图 1.13 (b)]。DYLEMA 项 目的 主 
要 目的 是 开发 整个 系统 ， 整 合 腿 部 运动 和 传感器 系统 领域 的 相关 技术 ， 以 满足 目 
前 人 道 主义 扫雷 行动 的 需要 。 

最 后 提 到 的 六 足 机 器 人 是 基于 昆虫 构 型 ， 但 也 有 不 同 的 构 型 ， 如 滑动 框架 ， 
这 些 步 行 机 器 人 正在 针对 扫雷 任务 进行 测试 (Habumuremyi,1998; Marques 
等 ，2002) 。 

总 而 言 之 ， 为 开发 可 排 雷 步行 机 器 人 ， 研 究 人 员 做 了 大 量 的 工作 。 


1.6 四 足 机 器 人 与 六 足 机 器 人 


开发 一 个 步行 机 器 人 首先 要 定义 腿 的 数量 。 这 个 数字 是 机 器 人 拥有 不 同 功 能 
和 具体 应 用 要 求 两 者 之 间 权 衡 的 结果 。 这 种 平衡 涉及 稳定 性 、 速 度 、 可 靠 性 、 重 
量 和 价格 。 

例如 ， 六 足 机 器 人 比 四 足 机 器 人 具有 更 好 的 静态 稳定 性 。 六 足 机 器 人 在 任何 
时 候 都 可 以 通过 用 5 条 腿 支 撑 机 体 来 执行 静态 步 态 ， 而 四 足 至 少 有 3 条 腿 支 撑 。 
这 个 功能 使 六 足 机 器 人 比 四 足 机 器 人 更 加 稳定 ， 因 为 可 以 使 用 更 大 的 支撑 多 
边 形 。 

速度 也 是 机 器 人 运动 的 关键 因素 ， 可 能 关系 到 在 工业 和 服务 业 中 的 表现 。 
Waldron 和 他 的 同事 证 明 ， 执 行 波浪 步 态 的 步行 机 器 人 的 速度 vv 取决 于 腿 部 步 幅 
及 、 腿 部 摆动 时 间 rt 和 占 空 因 数 8,B 取决 于 腿 的 数量 (Waldron 等 ，1984)， 
v 为 

oR 

具有 条 腿 的 机 器 人 的 最 小 占 空 因 数 为 B, = 二 3/n。 即 , B= 二 3/4,， B =3/6, 
&=3/8 Alb, :机 器 人 的 速度 为 ; w =0.333(R/t); w =R/t, v =1.67(R/t). 
六 是 机 器 人 比 四 是 机 器 人 速度 更 快 ， 而 八 足 机 器 人 甚至 更 快 。 

在 步行 机 器 人 的 发 展 过 程 中 一 些 研究 人 员 已 经 指出 ， 六 足 机 器 人 可 以 在 发 生 
故障 后 继续 行走 ， 最 多 故障 腿 为 2 条 腿 (每 侧 1 条 腿 )。 这 是 一 种 极端 的 从 六 足 
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机 器 人 变 为 四 足 机 器 人 的 方法 。 换 名 话说 ， 六 足 机 器 人 是 静态 宛 余 的 稳定 步行 机 
WA. BEA 1 条 或 2 条 失效 的 腿 也 能 行走 ， 因 为 可 以 使 用 其 中 的 4 条 腿 定义 稳 
定 步 态 。 例 如 ,虽然 每 个 人 都 看 到 过 昆虫 以 5 条 腿 行走 ,但 5 条 腿 的 机 器 人 被 困 
在 洞 里 行走 是 比较 难以 想象 的 。 可 以 理解 ， 一 条 腿 失效 极 大 地 限制 了 机 器 人 的 移 
动 性 。 因 此 ， 六 足 机 器 人 的 理论 元 余 不 能 真正 被 认为 是 超过 四 足 机 器 人 的 优势 。 

六 足 机 器 人 还 存在 其 他 问题 ， 例 如 可 靠 性 。 更 多 的 腿 意 味 着 更 复杂 的 机 构 和 
更 庞大 的 电子 和 传感器 系统 。 因 此 ， 失 败 的 可 能 性 增加 ， 任 务 成 功 的 可 能 性 
减少 。 

机 器 人 总 重 是 另 一 个 不 利 因素 。 机 器 人 机 体重 量 为 Ws， 其 中 不 包括 腿 的 重 
量 。 令 一 条 腿 的 重量 为 Wi， 机 器 人 总 重 Wr 为 

W,=W,;+7W, 

基于 机 器 人 SILO4 的 腿 和 机 体 的 设计 (参见 附录 A)， 得 到 Wy = 14kg, 
太一 4kg。 因 此 ， 一 个 四 足 机 器 人 的 总 重量 是 30kg 一 一 SILO4 的 实际 重量 ,而 
一 个 六 足 机 器 人 是 38kg。 可 见 六 足 机 器 人 的 总 重量 增加 约 27%。 在 两 种 机 器 人 
的 构 型 中 ， 总 重量 必须 由 3 个 支撑 腿 支 撑 ， 也 是 保证 静态 稳定 所 需 的 最 小 数量 ， 
因此 ， 六 足 机 器 人 理论 上 必须 使 用 与 四 足 机 器 人 相同 类 型 的 腿 。 

在 自然 界 中 ， 没 有 超过 100g 的 六 条 腿 动物 可 以 在 陆地 上 行走 (Williams, 
2005)。 因 此 ， 重 达 100g 至 几 吨 的 四 足 机 器 人 应 该 比 六 足 机 器 人 的 效率 高 得 多 。 
需要 指出 的 是 ， 六 足 机 器 人 只 能 在 静态 条 件 下 与 四 足 机 器 人 竞争 速度 和 稳定 性 。 
如 果 为 四 足 机 器 人 提供 更 准确 的 稳定 性 测量 和 控制 算法 ， 稳 定性 可 以 大 大 提高 。 
如 果 四 足 步行 机 器 人 可 以 实现 动态 步 态 和 动态 控制 规则 ， 速 度 将 会 更 快 。 

总 之 ， 继 续 研 究 四 足 机 器 人 有 很 多 原因 ， 本 书 的 主要 目的 是 鼓励 研究 人 员 折 
展 四 足 机 器 人 技术 。 为 此 ， 这 本 书 内 包含 了 我 们 最 近 十 年 开发 的 主要 算法 和 技 
术 ， 这 些 都 在 SILO4 步行 机 器 人 上 进行 了 测试 。SILO4 补充 材料 ， 如 图 片 、 视 
频 、 仿 真 软件 、 施 工 图 纸 等 ， 可 在 网 站 http: //www. iai. csic. es/users/silod 上 
找到 。 
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步行 机 器 人 稳定 性 研究 始 于 20 世纪 60 年 代 中 期 ， 当 时 McGhee 和 Frank 
(Frank, 1968) 首先 定义 了 理想 步行 机 器 人 的 静态 稳定 性 。 按 照 他 们 的 定义 ， 
理想 的 静态 稳定 是 指 机 器 人 重心 (COG) 的 水 平 投影 位 于 支撑 多 边 形 内 。 理 想 
机 器 人 应 该 有 无 质量 的 腿 ， 并 且 系 统 的 动力 学 假设 是 不 存在 的 。 

静态 稳定 性 的 想法 是 受到 昆虫 的 启发 。 这 些 节肢 动物 的 特征 是 其 骨骼 由 分 段 
的 身体 和 关节 附 肢 组 成 。 昆 虫 在 行走 时 使 用 无 质量 的 腿 支 撑 身 体 ， 并 推进 身体 前 
进 。 因 此 ， 为 了 在 保持 身体 平衡 的 同时 移动 身体 ， 它 们 合理 布置 迈步 顺序 ， 以 确 
保 静 态 稳定 性 。 第 一 代步 行 机 器 人 仿效 了 这 种 运动 原理 (Kumar 和 Waldron, 
1989) 。 早 期 的 步行 机 器 人 体积 巨大 、 肢 体 沉 重 、 难 以 控制 (Song 和 Waldron, 
1989), ， 而 采用 静态 稳定 的 步 态 可 以 简化 控制 机 构 。 但 是 ， 在 沉重 的 肢体 和 机 体 
的 运动 过 程 中 ， 一些 惯 性 作用 和 动态 效应 (摩擦 、 弹 性 等 ) 限制 了 机 器 人 的 恒定 
低速 运动 。 因 此 ， 采 用 静态 稳定 运动 控制 是 以 速度 为 代价 的 。 

提高 步行 机 器 人 速度 的 唯一 方法 是 采用 机 器 人 动态 稳定 性 控制 。 考 虑 整个 机 
器 人 动态 的 内 在 复杂 性 (参见 第 6 章 )， 一 些 研究 人 员 设 计 了 仅 具 有 几 个 自由 度 
的 机 械 简 化 机 器 作为 解决 方案 (Raibert 等 ，1986; Wong 和 Orin, 1993; Bue- 
hler 等 ，1998) 。 其 采用 双 足 设计 的 稳定 性 标准 〈 即 类 人 机 器 人 )， 并 附加 到 其 他 
几 条 腿 上 。 因 为 这 些 稳定 性 标准 是 基于 零 力矩 点 的 ， 因 此 四 足 运 动 只 限于 平坦 地 
面 (Vukobratovic 和 Juricic，1969)， 也 只 对 平坦 表面 有 效 (Goswami, 1999; 
Kimura 等 ，1990; Yoneda 等 ，1996)。 此 外 ， 这 些 简 化 的 机 械 设 计 使 得 机 器 人 
无 法 在 实际 中 应 用 ， 因 为 无 法 操纵 和 有 效 运输 载荷 。 对 限制 机 器 人 静态 稳定 性 能 
的 动态 效应 的 研究 很 少 (Gonzalez de Santos 等 ，1998; Kang 等 ，1997; Lin 和 
Song, 1993; Papadopoulos 和 Rey, 1996; Yoneda 和 Hirose, 1997; Garcia 和 
Gonzalez de Santos，2005) 。 但 是 ， 腿 部 运动 研究 的 目标 之 一 是 步行 机 器 人 在 工 
业 上 使 用 ， 这 些 机 器 人 并 不 总 是 小 跑 或 驰 驴 ， 也 应 在 不 平坦 的 地 形 上 静态 稳定 地 
行走 。 

四 足 行走 动态 稳定 标准 有 多 个 定义 ， 均 以 不 同 的 形式 和 名 字 定 义 了 同一 个 想 
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法 : 力矩 可 以 导致 由 作用 于 车 辆 质心 的 动态 效应 引起 的 绕 支 撑 多 边 形 边缘 的 旋 
转 。 每 个 标准 应 用 的 适用 性 〈 即 操纵 力 和 力矩 存在 、 不 平坦 的 地 形 等 ) 并 不 明 
确 。 但 稳定 性 标准 不 适用 于 当前 应 用 场景 。 因 此 ， 在 本 章 中 ，2.2 节 和 2.3 节 简 
要 介绍 了 毅 态 和 动态 稳定 性 标准 。2.4 节 比较 研究 实施 这 些 稳定 边界 ， 分 析 在 不 
同 的 静态 和 动态 情况 的 适用 性 。 该 比较 研究 通过 仿真 测试 四 足 机 器 人 实现 ， 仿 真 
特性 见 附录 B. 

步 态 生成 有 利于 控制 机 器 人 的 COG 运动 ， 保 证 给 定 的 稳定 性 水 平 。2. 5 节 
提出 了 稳定 性 水 平 曲线 可 用 于 此 目的 。 


2.2 静态 稳定 性 标准 


McGhee 和 Frank (1968) 提出 第 一 个 静态 稳定 性 标准 。 在 水 平 、 平 坦 的 地 
形 ， 理 想 机 器 沿 着 恒定 方向 、 以 恒定 速度 静态 行走 。 重 力 投影 中 心 方法 称 如 果 其 
COG 的 水 平 投影 位 于 在 支撑 多 边 形 内 〈 定 义 为 通过 连接 是 印 形成 的 凸 多 边 形 )， 
车 辆 静态 稳定 。 后 来 这 个 标准 扩展 到 不 平坦 的 地 形 (McGhee 和 Iswandhi， 
1979)， 通 过 重新 定义 支撑 多 边 形 的 水 平 投影 作为 真正 的 支撑 模式 。 静 态 稳定 裕 
E Som XA COG 投影 到 支撑 多 边 形 边缘 的 最 小 距离 。Ssu 是 在 水 平 、 缓 变 地 形 
上 ， 理 想 机 需 稳 定 裕 度 的 最 佳 选 择 。 然 而 ， 计 算 Sm 的 方程 是 复杂 的 。 因 此 ， 
Zhang 和 Song (1989) 提出 了 纵向 稳定 裕 度 Sisw， 定 义 为 沿 着 机 器 的 纵 轴 从 
COG 投影 到 支撑 多 边 形 前 后 边缘 的 最 小 距离 。Sisw 是 Ssm 的 近似 值 ， 计 算 更 简 
单 。 然 而 ， 考 虑 到 步行 机 器 人 作为 加 速 过 程 中 产生 惯性 效应 的 非 理 想 车 辆 ， 使 用 
蟹 行 纵 向 稳定 裕 度 Scism (Zhang 和 Song, 1990) 将 更 加 方便 。Scrsm 是 沿 着 机 器 
的 运动 方向 从 COG 投影 到 支撑 多 边 形 前 后 边缘 的 最 小 距离 。 图 2.1 显示 了 对 于 


支撑 多 边 形 


图 2.1 支撑 多 边 形 和 不 同 的 静态 稳定 裕 度 
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给 定 的 支撑 多 边 形 的 Ssma Sis Al Scusv o 

Mahalingham 等 (1989) 定义 了 保守 支撑 多 边 形 (CSP) 作为 支撑 多 边 形 的 
子 集 ， 以 便 限 制 COG 的 运动 ,在 任何 情况 下 保证 支撑 腿 系 统 稳定 。 然 而 ，CSP 
的 使 用 仅 限于 使 用 息 行 步 态 的 六 足 或 更 多 足 的 机 器 。 

上 述 稳定 性 标准 均 基于 几何 概念 ，Ssw 、Sism 和 Sesu dhar F COG AE, 不 
考虑 运动 学 和 动力 学 参数 。 直 观 上 ， 一 个 非 理 想 的 稳定 性 步行 机 器 应 依赖 于 这 些 
参数 。 


Messuri (1985) 提出 了 一 个 更 好 的 稳定 性 测量 方法 。 他 定义 能 量 稳定 裕 度 
SrsM 为 机 器 人 绕 支 撑 多 边 形 的 边缘 滚动 需要 的 最 小 势能 ， 即 


5. non (3.415 
h; = |R;|(1—cos0) cos G25 25 
AP i 支撑 多 边 形 作为 旋转 轴 的 分 段 ; 


支撑 腿 的 数量 ; 

hh 一 一 翻滚 时 COG 高 度 的 变化 ; 

R; 一 一 从 COG 到 旋转 轴 的 矢量 

0 一 一 R, 与 垂直 平面 形成 的 角度 

少 一 一 相对 于 水 平面 旋转 的 倾斜 角 。 

用 于 计算 Sssw 的 几何 示意 图 如 图 2. 2 所 示 。 


n, 


图 2.2 用 于 计算 Sesu 的 几何 示意 图 


Sgsu 是 一 种 更 有 效 的 静态 稳定 性 量度 。 它 给 出 一 个 对 车 辆 所 遭受 的 冲击 能 量 
的 定性 影响 ， 同 时 考虑 COG 高 度 的 影响 。 但 是 ，Sesw 仍 然 没 有 考虑 动态 效应 可 
能 会 扰乱 车 辆 稳定 性 。Sssv 既 不 考虑 顺应 性 地 形 的 影响 ， 也 不 考虑 非 支撑 腿 的 稳 
EMH. Nagy (1991) 提出 ， 作 为 Sesw 的 扩展 ， 考 虑 顺应 松软 地 形 ， 即 顺应 能 
量 稳 定 裕 度 Socom, ， 同 时 他 也 扩展 Sesv 的 概念 ， 考 虑 了 在 空气 中 的 腿 部 稳定 作用 ， 
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即 倾 翻 能 量 稳定 裕 度 Sresw 。 对 于 大 多 数 步 行 机 器 ，Sesw 和 Srssw 重 合 ， 因 为 非 支 
撑 腿 距离 地 面 太 远 ， 无 法 增强 稳定 性 。 只 有 基于 框架 的 车 辆 〈Ishino 等 ，1983) 
才 会 显现 出 这 种 稳定 性 的 优势 。 

最 后 ，Hirose 等 (1998) 将 Sesw 基 于 机 器 人 重量 归 一 化 ， 提 出 了 归 一 化 能 量 
稳定 裕 度 Snes 9 定义 为 


《2. 3) 


SNEsM = 


SNssM 被 证 明 是 静态 稳定 步行 机 器 最 有 效 的 稳定 裕 度 。 但 是 ， 当 机 器 行走 出 
现 动态 效应 时 ， 稳 定性 无 法 准确 判断 。 这 种 情况 在 步行 机 器 人 应 用 中 是 真实 存在 
的 ， 因 此 动态 稳定 裕 度 更 适用 。 


2.3 动态 稳定 性 标准 


使 用 扑 行 步 态 的 四 足 机 器 的 第 一 个 动态 稳定 性 标准 是 由 Orin (1976) 提出 
的 重心 投影 方法 。 压 力 中 心 (COP) 方法 定义 为 : 对 于 动态 稳定 的 机 器 人 ， 作 用 
Æ COG 上 的 力 ， 沿 着 COG 点 合力 方向 的 投影 位 于 支撑 多 边 形 内 的 则 稳定 。 因 
此 动态 稳定 裕 度 定义 为 COP 距 支撑 多 边 形 边缘 的 最 小 距离 ， 参 见 Gonzalez de 
Santos (1998) 的 文献 。COP 方法 与 重心 投影 方法 在 静态 条 件 和 不 平坦 的 地 
形 是 一 致 的 。 因 此 它 上 具有 相同 的 缺点 ， 如 2. 2 节 所 述 。 

Kang 等 (1997) 随后 将 COP 更 名 为 有 效 质量 中 心 (EMC) ， 并 将 其 重新 定 
义 为 支撑 平面 上 的 点 ， 此 点 处 由 地 面 反 力 引 起 的 力 和 力矩 均 为 零 。 注 意 EMC 的 
定义 与 两 足 机 器 人 文献 中 的 称 为 零 时 刻 点 (ZMP)〉 是 一 致 的 ， 后 者 是 由 Vuko- 
bratovic 和 Juricic (1969) 首次 定义 的 。 但 是 ， 在 四 足 中 使 用 ZMP 比 在 两 足 中 
应 用 得 少 ， 因 为 Yoneda 和 Hirose (1997) 表示 ，EMC 或 ZMP 稳定 性 标准 对 于 
不 平坦 的 地 形 是 无 效 的 〈 计 算 ZMP， 支 撑 多 边 形 必须 限制 在 一 个 平面 上 ) 。 

一 些 基 于 力矩 的 稳定 性 标准 也 得 到 了 定义 ， 这 里 只 介绍 最 有 意义 的 。 如 图 
2.3 (a) 所 示 的 机 器 人 和 机 械 手 系统 。 力 和 力矩 作用 于 COG， 可 能 会 破坏 其 稳 
EE, ERAR. COG 点 的 动态 平衡 满足 

F,=F,+Fo+Fx« (2. 4) 
Mi 一 Ms 十 Me 十 Muv (2.5) 

下 标 I、S、G 和 M 分 别 表示 惯性 、 支 撑 、 重 力 和 操纵 影响 。 

在 翻滚 期 间 ， 机 器 人 失去 了 大 部 分 的 支撑 足 ， 只 剩 下 与 旋转 轴 一 侧 的 足 ， 如 
图 2. 3 (b) 所 示 。 机 器 人 与 地 面 之 间 的 反作用 力 Fe AGA Mr 是 由 每 一 个 足 
产生 的 地 面 反 作用 力 及 绕 COG 的 合力 矩 组 成 。 为 保持 机 器 人 稳定 ， 合 力 和 力矩 
产生 绕 旋转 轴 的 力矩 M;， 必 须 补 偿 破 坏 稳定 的 力 和 力矩 来 确保 系统 稳定 。 当 这 
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Cb) 机 器 围绕 旋转 轴 翻 滚 


图 2. 3 一 些 基于 力矩 的 稳定 性 标准 的 定义 


种 补偿 不 足 时 ， 即 系统 动态 不 稳定 。 
基于 这 一 说 法 ，Lin 和 Song (1993) 重新 界定 了 动态 稳定 裕 度 Som, EH 
所 有 在 支撑 多 边 形 中 每 个 旋转 轴 最 小 的 力矩 Mi， 归 一 化 为 系统 的 重量 ， 即 
Sosu = min ML) = min [E EXP. FM? (2.6) 


mg 
式 中 P; 一 一 从 COG 到 第 ;支撑 足 的 位 置 矢量 ; 
e; 一 一 以 顺 时 针 方 向 绕 支 撑 多 边 形 的 单位 矢量 。 

如 果 所 有 力矩 都 是 正 的 ( 即 有 相同 的 方向 ， 与 e; 单位 相同 ) ， 那 么 系统 是 稳 
定 的 。 
注意 ，Spsm 可 同时 用 于 Orin, Lin 和 Song 的 动态 稳定 裕 度 标准 ,但 在 本 章 
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中 ，Spsu 是 特定 指 Lin 和 Song 的 标准 ， 而 Orin 的 动态 稳定 称 为 Szu o 

几 年 后 ，Yoneda 和 Hirose (1997) 基于 相同 的 判定 ， 提 出 了 翻滚 稳定 。 在 
动态 平衡 系统 中 ， 假 设 腿 部 无 质量 ， 所 以 腿 部 支撑 点 和 足 部 反 力 点 重合 。 在 他 们 
的 研究 中 ，Yoneda 和 Hirose 使 用 从 地 面 反 作用 力 Fe 和 力矩 My 获得 的 结果 ， 
动态 系统 平衡 定义 如 下 : 


Fr=F— Fe— Fw (2.7) 
—Mz=M,—Mc— Mx (2. 8) 
因此 ， 绕 旋转 轴 的 力矩 Mi; 为 
M| =—Mkge;— Fr X Pee: (2.9) 
WER., A 2.9) 中 的 力矩 恰好 与 在 式 (2. 6)- 中 使 用 的 力矩 相反 。 
翻滚 稳定 性 判断 表明 系统 是 动态 稳定 的 ， 如 果 存 在 任何 支撑 足 j 在 旋转 方向 
上 ， 则 阻止 系统 翻滚 。 翻 滚 稳定 裕 度 SrH 


Sa 一 min( M L) (2: 10) 


ms 
最 近 Zhou (2000) 提出 了 足 端 支撑 力矩 标准 。 其 稳定 裕 度 与 Stsm 完 全 相 
同 ， 但 用 户 可 获得 来 自传 感 器 的 力 Fe 和 力矩 Ma BEH. AI, Sies itte Ta 
能 出 现在 Srsw 中 忽视 腿 部 动力 效应 的 问题 。 
除了 基于 ZMP 和 基于 动量 的 稳定 性 标准 ，Papadopoulos 和 Rey (1996) 还 
提出 了 不 同 的 标准 。 力 一 角 稳 定性 标准 ， 找 到 从 COG 作用 地 面 Fo 与 反作用 
力 相反 一 垂直 力 R; 作 用 的 合力 垂直 于 COG 旋转 轴 之 间 的 角度 w 〈 图 2.4)。 当 该 


图 2.4 力 一 角 稳定 裕 度 的 几何 问题 


33 


部 分 ”步行 测量 和 算法 


角度 变 为 零 时 ， 系 统 变 得 不 稳定 。 力 一 角 稳 定 裕 度 是 最 小 角度 乘 以 合力 Fr 模块 
的 结果 ， 即 | 
Srasm=min(a;) || Fe | CATI 
ER, LEDER A RMA E EAER T OAA E EME. AR AS Fk Ee A E 
的 研究 证 明 ，Sesw 在 静态 条 件 下 是 最 佳 的 〈Hirose 等 ，1998) 。 当 作用 于 机 器 人 
的 唯一 重要 的 力 是 重力 时 ， 一 些 研究 提出 将 Sesw 概 念 扩 展 到 机 器 人 动力 学 的 其 
他 方面 ， 如 惯性 力 或 操纵 效应 。Sssw 计 算 当 围绕 支撑 多 边 形 的 边缘 旋转 时 ， 机 器 
COG 经 历 的 势能 增加 (参见 2. 2 节 ) 。 因 此 ，Sssw 扩 展 到 存在 的 其 他 动态 机 器 人 
时 ， 计 算 COG 经 历 翻 滚 的 机 械 能 增加 ， 这 个 想法 首先 由 Ghasempoor 和 Sepehri 
(1998) 提出 ， 以 测量 机 器 人 稳定 性 在 基于 轮 式 移动 操纵 中 的 应 用 。 后 来 ，Gar- 
cia 和 Gonzalez de Stantos (2005) 扩大 了 Ghasempoor 和 Sepehri 用 于 步行 机 器 
人 的 想法 ， 考 虑 到 腿 部 动力 学 作为 一 个 不 稳定 的 影响 ， 将 其 归 一 化 为 机 器 人 的 重 
量 。 产 生 归 一 化 动态 能 量 稳 定 裕 度 Svwvesw ， 通 过 模拟 验证 ， 在 操纵 动力 和 外 部 扰 
动 的 情况 下 ， 在 不 平坦 的 地 形 上 准确 量化 了 机 器 人 的 稳定 性 。 
归 一 化 动态 能 量 稳定 裕 度 定义 为 机 器 人 围绕 支撑 多 边 形 翻滚 所 需 的 最 小 稳定 
水 平 ， 通 过 机 器 人 质量 进行 归 一 化 〈 图 2.5)， 即 


_ min(E; ) 
mg 


2.12) 


Snopes 


图 2.5 用 于 计算 Swoesm 的 向 量 图 


其 中 五 ,表示 支撑 多 边 形 的 第 ; 侧 的 稳定 性 度量 ， 即 绕 机 器 人 支撑 多 边 形 翻滚 
的 第 ; 侧 所 需 的 机 械 能 增 量 ， 由 下 式 计算 
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E;=mg|R|(cos$—cosg)cosyg+ (Fri * t)|R|O+ Mr 。 e0- Iw? (2. 13) 


式 中 R 指向 COG 位 置 与 支撑 多 边 形 的 第 ;人 侧 垂直 的 正 交 矢量 ; 
Fr! 一 一 合力 的 非 重 力 分 量 / 地 面 作用 力 Fe 
I; 一 一 绕 旋 转轴 i 的 惯性 力矩 ，; 
wi 一 一 COG 的 角速度 ; 
由 一 一 支撑 多 边 形 的 第 i 侧 的 倾斜 角度 ; 
4 一 一 在 垂直 平面 内 定位 COG 所 需 的 旋转 角度 (图 2. 5); 
$——COG 从 垂直 平面 旋转 到 临界 平面 的 角度 ， 其 中 作用 在 COG 合力 
A; 
0 一 一 两 个 旋转 的 相 加 。 
单位 矢量 上 与 COG 轨迹 相 切 ，e; 是 以 顺 时 针 方 向 绕 支 撑 多 边 形 的 单位 矢量 。 
式 (2. 13) 等 号 右 侧 的 mg|R| (cos$— cose) cosy, (Fr ° DIRIA, (Mr ° e;)0 表示 


由 重力 、 非 重力 和 力矩 引起 翻滚 所 需 的 势能 ， — Fe! 表示 动能 。 更 详细 的 解释 


参见 Garcia 和 Gonzalez de Santos (2005) 的 文献 。SNpesv 是 唯一 考虑 冲击 作用 ， 
即 外 部 和 干扰 对 机 器 人 稳定 性 影响 的 动态 稳定 裕 度 。 

上 述 这 些 是 目前 在 步行 机 器 控制 中 使 用 的 主要 稳定 性 判定 标准 。 其 中 有 些 定 
义 了 相同 的 稳定 裕 度 ， 他 们 之 间 并 没有 明确 的 差异 。 此 外 ， 在 实际 情况 下 判断 稳 
定性 的 适应 性 时 ， 例 如 在 倾斜 的 地 形 上 、 存 在 操纵 力 和 力矩 或 在 腿 的 摆动 相 有 惯 
性 力 时 ， 无 法 直接 从 定义 中 得 出 。 

下 文 介绍 专门 用 于 应 对 现 有 稳定 裕 度 缺乏 定量 的 信息 。 为 此 ， 针 对 不 同 静 态 
和 动态 情况 和 不 同 的 地 形 特征 ， 进 行 稳定 裕 度 的 比较 。 


2.4 稳定 裕 度 的 比较 研究 


这 项 比较 研究 的 目的 是 得 出 一 个 稳定 裕 度 定性 的 分 类 ， 确 定 对 于 每 个 应 用 场 
景 的 适用 性 。 用 于 分 析 的 稳定 裕 度 为 Ssuw、Swesm、Spsu 、SrsM、SrasM、Szvp 《也 
称 为 Sewe) 和 SNpssw。 机 器 人 使 用 两 相 不 连续 步 态 行走 时 ， 在 以 下 6 个 不 同 的 地 
形 和 动态 效应 情况 下 分 别 计算 上 述 值 (3.4 节 )。 

(1) 情况 1: 没有 动力 的 水 平 、 平 坦 地 形 。 

(2) 情况 2: 没有 动力 的 不 平坦 地 形 。 

(3) 情况 3: 在 水 平 、 平 坦 地 形 出 现 惯性 和 弹性 效应 时 。 

(4) 情况 4: 地 形 不 平坦 ， 出 现 惯性 和 弹性 效应 时 。 

(5) 情况 5: 在 水 平 、 平 坦 地 形 出 现 惯性 、 弹 性 和 操纵 力 时 。 
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(6) 情况 6: 在 不 平坦 地 形 出 现 惯性 、 弹 性 和 操纵 力 时 。 

ER 6 种 情况 研究 代表 了 四 足 机 器 人 的 6 个 实际 应 用 场景 。 由 于 使 用 各 种 四 
足 机 器 人 执行 6 种 情况 比较 难 〈 即 在 情况 1 和 情况 2 中 没有 机 器 人 动力 ,情况 5 
和 情况 6 存在 操纵 动态 等 )， 因 此 这 一 分 析 是 通过 对 四 足 机 器 人 仿真 模拟 得 出 的 。 
使 用 在 附录 B 中 描述 的 模拟 设置 构建 ， 通 过 使 用 仿真 软件 对 不 同 地 形 剖 面 和 不 
同 机 器 人 动力 特性 进行 了 探索 。 在 模拟 中 使 用 的 两 相 不 连续 步 态 (3. 4 节 ) 的 特 
征 ， 在 于 腿 部 序列 和 机 体 运动 。 腿 部 的 序列 为 一 条 腿 摆 动 的 同时 ， 另 外 三 条 腿 支 
撑 机 体 。 四 条 腿 均 支撑 在 地 面 上 时 机 体 向 前 移动 (机体 运动 )。 

图 2.6 和 图 2. 7 分 别 显示 了 情况 1 和 情况 2 的 步 态 周期 的 一 半 ， 包 括 后 腿 摆 
动 、 前 腿 摆 动 和 机 体 运 动 。 从 图 2.6 和 图 2.7 AAAH, Ss, Som, Srm 和 
Sm 相同 。 高 度 不 同 的 COG 的 裕 度 也 相同 。 这 与 情况 1 的 研究 是 相关 的 (图 
2.6) ， 当 地 形 是 水 平和 平坦 的 ， 这 4 个 裕 度 不 随 COG 的 高 度 变化 。 这 是 所 有 4 
个 标准 的 缺点 ， 因 为 COG 高 度 的 增加 会 导致 机 体 不 稳定 。 而 在 情况 2 研究 中 ， 
对 于 不 平坦 的 地 形 (图 2. 7)，6 个 裕 度 均 考虑 了 COG 的 高 度 。 当 Swvesu 最 大 时 
刻 ， 垂 直 的 虚线 在 机 体 支持 相 内 部 ， 间 隔 指向 区 间 ; 在 水 平地 形 上 这 个 区 间 是 支 
撑 相 间隔 的 一 半 。 对 于 情况 1 这 一 区 间 与 所 有 裕 度 一 致 。 


后 腿 摆 动 前 腿 摆 动 机 体 运动 
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图 2.6 当 系 统 在 水 平地 形 ， 不 存在 动力 情况 下 的 不 同 稳定 裕 度 (情况 1) 
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后 腿 摆动 前 腿 摆 动 
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图 2.7 在 倾角 为 10" 地 形 上 且 没 有 动力 的 情况 下 不 同 的 稳定 裕 度 (情况 2) 


在 水 平 、 平 坦 的 地 形 上 ， 只 有 Swesuv、SrFasw 和 Swpesm 有 反映 了 机 体高 度 增加 对 
裕 度 的 影响 。 因 此 ， 它 们 可 以 为 情况 1 提供 较 准 确 的 稳定 性 测量 。 

在 斜面 上 (图 2.7), Syesms Srasm 和 Sossv 的 最 大 稳定 区 间 与 其 他 不 同 。 
Snes Fl SNpssv 一 致 ，Ssv、SpsM 、Srsw 和 Szmp 达到 最 大 (也 是 一 致 的 )。 此 外 ， 
Srasu 的 最 大 值 滞后 于 Swvesu 的 最 大 值 。 要 解决 的 主要 问题 似乎 是 情况 2 中 哪 一 
种 裕 度 最 好 。Hirose (1998) 进行 了 实验 以 确定 哪个 静态 稳定 裕 度 是 最 合适 
的 。 他 们 制作 了 一 个 小 型 的 步行 机 器 人 模型 ， 并 使 用 一 个 冲击 发 生 装置 产生 对 机 
器 人 模型 的 冲击 力 。 机 器 人 模型 被 放置 在 倾斜 的 地 面 上 上， 其 COG 放置 在 每 个 稳 
定 裕 度 的 最 大 位 置 ， 分别 从 下 坡 和 上 坡 产生 侧面 冲击 。 实 验 得 出 的 结论 是 ， 当 
COG 被 放置 在 最 大 Swesmu 点 时 ， 有 可 能 翻 深 ， 下 坡 等 于 上 坡 ， 因 此 ，Swesu 是 最 
合适 的 静态 稳定 裕 度 。SNssv 测 量 系统 可 以 吸收 在 翻滚 期 间 产 生 的 冲击 能 量 。 考 
虑 到 情况 2 研究 与 Hirose 等 进行 的 实验 相 吻 合 ， 当 机 器 人 动力 可 以 忽略 不 计时 ， 
在 倾斜 地 形 上 SNssw 和 SNoesw 是 四 足 机 器 人 最 适合 的 。 

为 了 表明 各 种 稳定 裕 度 的 最 大 时 刻 总 是 不 同 于 最 大 Swvesu 和 SNesv ， 同 时 考 
虑 到 Ssw 、Spsv 、Srsw 和 Szwp 在 这 种 情况 下 的 研究 是 一 致 的 ，SNesw 和 Snpgsm 也 是 
一 致 的 。 接 下 来 比较 Ssw 、Sxossw 和 Srssw 对 不 同 倾角 地 形 的 稳定 性 测量 。 图 2.8 Ca) 
显示 了 Sypesm 和 Ssm 最 大 区 间作 为 地 形 倾角 的 函数 之 间 的 差异 ,图 2.8 Cb) 显示 
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了 最 大 Sras Fl Snvgsm 的 区 间 之 间 的 差异 。 图 2.8 (a) 显示 了 对 于 不 同 的 正 倾角 
和 负 倾 角 的 地 形 Ssu 的 最 大 区 间 总 是 在 SNpssv 的 最 大 区 间 之 前 。 此 外 ， 对 于 不 同 
倾角 的 地 形 ，Ssssw 的 最 大 区 间 始 终 跟 随 Swvesm 的 最 大 区 间 ， 如 图 2.8 (b) 所 示 。 
因此 ， 只 有 在 地 形 是 水 平 或 平坦 的 ，Ssw 和 Srasm 的 最 大 区 间 与 Swpesu 的 最 大 区 间 
是 一 致 的 。 如 果 地 形 有 和 斜坡，Ssw 和 Srasw 始 终 不 是 最 合适 的 稳定 裕 度 。 
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图 2.8 不 同 倾角 地 形 的 最 大 稳定 区 间 的 差异 


图 2.9 和 图 2. 10 分 别 显示 了 在 水 平和 倾斜 的 地 形 上 行走 情况 3 和 情况 4 的 
步 态 周 期 的 一 半 ， 这 分 别 对 应 于 机 器 人 存在 的 惯性 效应 。 关 于 关节 弹性 的 弹性 影 
响 和 地 面 接触 作用 也 进行 了 介绍 。 

在 水 平地 形 (图 2. 9)， 所 有 稳定 裕 度 的 最 大 稳定 区 间 仍 然 重 合 。 但 Snsw、 
Srswv、Srasv、Szwp 和 SNprsv 反 映 了 由 于 腿 部 抬升 ， 作 用 关节 的 弹性 和 机 体 运 动 引 
起 的 一 些 振荡 ， 即 腿 部 摆动 相 摆 动 ) 和 机 体 运动 的 惯性 作用 可 以 反映 出 来 。 但 
Sou Fil Swesu 不 反映 这 些 动态 效应 ， 因 为 它们 是 静态 稳定 裕 度 。 图 2. 11 显示 了 
Ssu 和 Spsw 曲 线 之 间 在 这 一 点 上 的 差异 。Snsw 经 历 了 由 腿 部 抬升 和 机 体 推 进 的 惯 
性 作用 导致 的 稳定 性 下 降 ， 以 及 足 部 放置 和 机 体 运 动 的 关节 弹性 引起 的 振动 。 

因此 ， 当 涉及 惯性 和 弹性 效应 时 ， 只 有 动态 稳定 性 标准 才能 判断 稳定 性 。 但 
JE Som, Sron Szme 也 不 能 判断 ， 因 为 没有 考虑 高 度 变化 的 影响 。 只 有 Srnsm 
和 SNpssv 适 用 于 情况 3， 四 足 机 器 人 在 平地 上 行走 ， 机 器 人 的 动态 效应 是 不 能 忽 
略 的 。 

图 -2. 10 显示 了 情况 4 中 当地 形 倾斜 、 惯 性 和 弹性 效应 变 得 显著 时 的 稳定 裕 
度 研究 。Ssv 和 Swesu 不 会 反映 由 于 动力 效应 而 导致 的 稳定 裕 度 减少 (图 2.7)， 
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图 2.11 当 惯 性 和 弹性 效应 出 现时 在 水 平地 形 的 半 步 态 循环 周期 


Spsu、Srsm、SFasuv、Szmr 和 Swpgsm 反 映 了 稳定 性 的 下 降 。 最 大 稳定 值 Sras 的 发 
生 滞后 于 Spsw 、Srsw、Szup 和 Snpesw 。 同 时 ，Swoesu 最 大 值 滞后 于 Svsw 、Srsu 和 
Szwp 的 最 大 值 。 再 次 考虑 到 这 些 稳定 裕 度 之 间 的 差异 ， 在 不 平坦 的 地 形 上 行走 ， 
当 动 力 效应 显著 时 ， 应 倾向 于 哪 种 稳定 裕 度 呢 ? 模拟 了 类 似 于 Hirose 等 (1998) 
的 实验 ， 以 确定 在 不 平坦 地 形 最 合适 的 静态 稳定 裕 度 。 在 这 种 情况 下 ， 考 虑 到 四 
足 机 器 人 的 惯性 和 弹性 ， 同 时 模拟 与 机 器 人 运动 相反 的 25N 外 力 引起 机 器 人 跌 
倒 。 为 允许 数值 比较 ,计算 和 测量 无 量 纲 化 稳定 裕 度 。 以 此 为 目的 ，Swpesw 除 以 
机 器 人 高 度 (CH=0. 34m)，Spsm 除 以 步 幅 的 一 半 (P/2=0. 5m). 3 个 无 量 纲 的 
量 在 开始 运动 以 前 〈 当 没有 外 部 干扰 并 且 机 器 人 停止 运动 时 ) 有 相同 的 值 。 所 有 
无 量 纲 的 稳定 裕 度 给 出 相同 的 值 在 正常 情况 下 似乎 是 合理 的 。 图 2.12 (a) 显示 
了 翻滚 前 后 3 个 无 量 纲 的 稳定 裕 度 (在 :一 0.1s)。 翻 滚 后 ，3 个 稳定 裕 度 变 为 
零 ， 因 为 机 器 人 变 得 不 稳定 ， 无 法 进行 任何 一 个 稳定 裕 度 的 计算 。 但 是 ,在 翻滚 
之 前 ，3 个 稳定 裕 度 表现 不 同 。Srssv 反 映 出 在 滚动 之 前 测量 稳定 性 下 降 发 生 的 
JEI, Spss ÝI SNpgsv 显 示 从 运动 开始 起 稳定 性 的 下 降 。 在 翻滚 的 瞬间 Sosv 呈 现 不 
连续 性 。 这 在 图 2.12 b) POM, HAPERT 3 个 稳定 裕 度 的 导数 。Sosn 和 
SrAsM 的 导数 突变 导致 了 不 稳定 预测 错误 。 这 些 不 连续 性 似乎 是 由 0. 02s 采样 图 
中 的 数据 导致 的 ， 其 实 并 非 如 此 。 然 而 ， 稳 定 裕 度 突然 变 成 零 是 因为 当 机 器 人 变 
得 不 稳定 时 无 法 计算 稳定 裕 度 〈 支 撑 多 边 形 消失 )。 如 果 稳 定性 裕 度 可 以 计算 出 
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无 量 纲 稳定 裕 度 


0 0. L az 0. 3 0.4 0.5 0.6 0.7 0.8 
(a) 无 量 纲 的 Spsv Snpesm Al Srasm 曲线 


稳定 裕 度 导数 


i a ae fe ei [ee ee Wee 
0 0. 1 0. 2 0.3 0.4 Gus 0. 6 0.7 0.8 
t/s 


Cb) 由 于 外 力 为 一 25N 而 发 生 不 稳定 时 ， 无 量 纲 Spsw 、SNpEsu 和 Spasm 的 衍生 线 
图 2.12 翻滚 前 后 3 个 无 量 纲 的 稳定 裕 度 


来 ，Srassv 和 Spsm 肯 定 不 会 为 零 ， 如 图 2. 12 (a) 所 示 。 图 2. 12 中 ，Swpesm 连续 
变 为 零 ， 因 此 不 会 存在 预测 误差 。 因 此 ，Swvesu 在 机 器 人 稳定 性 测量 中 没有 误 
差 ， 可 以 精确 地 预测 机 器 人 的 不 稳定 性 。 这 显示 了 Sxpgsu 的 优势 ， 被 证 明 是 唯一 
精确 的 稳定 性 测量 。 在 :一 0. 12s 之 前 的 时 刻 ， 机 器 人 开始 下 降 ， 只 有 Snopes = 
0， 其 余 的 稳定 裕 度 将 给 出 不 等 于 零 的 裕 度 ， 这 对 机 器 人 控制 至 关 重 要 。 如 果 以 
这 样 的 方式 进行 机 器 人 步 态 控制 ， 即 稳定 裕 度 必须 始终 超过 一 定 的 值 ， 其 他 稳定 
裕 度 的 使 用 与 Swvesu 不 同 ， 将 会 在 稳定 裕 度 测量 时 产生 错误 ， 无 法 确定 机 器 人 的 

图 2.13 和 图 2. 14 显示 了 情况 5 和 情况 6 的 步 态 周期 的 一 半 ， 分 别 对 应 存在 
操作 效应 的 机 器 人 通过 水 平和 倾斜 的 地 形 ， 同 时 考虑 惯性 和 弹性 效应 。 这 两 个 图 
中 操纵 力 均 对 抗 运 动 ， 导 致 后 腿 处 于 摆动 相 时 的 稳定 性 下 降 ， 前 腿 处 于 摆动 相 时 
的 稳定 性 增加 。 另 外 ，Snbsw、Srsw 、Srasw 、Szmr 和 Swpesm 均 存在 最 大 稳定 时 刻 的 
延迟 。 从 图 2. 13 和 图 2. 14 中 可 以 看 出 ， 如 果 操 纵 力 增加 ， 机 器 人 在 后 腿 的 摆动 
期 间 可 能 会 不 稳定 。 这 种 效应 Sou A Snesm 无 法 预见 。 

SrasM 的 最 大 区 间 发 生 在 Sbsw、Srsw 、Szup 和 SNnssv 最 大 区 间 之 后 。 但 是 
Sossv 的 最 大 值 发 生 时 刻 在 Spsm 之 后 ， 在 Seam ZB. WE 2. 15 所 示 ， 对 于 不 同 
地 形 的 倾角 和 不 同 操纵 力 ， 比 较 了 Svsv 和 Srasw 与 Sypesm 的 最 大 区 间 。Sosn 和 
Sras ABE Swpesm 不 一 致 ， 后 者 对 具有 操作 力 效应 的 四 足 机 器 人 稳定 性 判定 最 为 
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图 2.13 当 在 水 平地 形 上 以 20N 恒定 的 力 反 向 运动 ， 出 现 惯性 、 弹 性 和 
操纵 效应 增加 时 不 同 的 稳定 裕 度 (情况 5) 


适用 。 

表 2. 1 总 结 了 稳定 裕 度 的 分 类 。 符 号 “~/ ”表示 标准 为 “有 效 ”， 符 号 “X” 
表示 “无 效 ”"， 符号“* ”表示 “最 合适 ”。Swvesu 是 作为 静态 稳定 裕 度 最 合适 的 
测量 量 。 但 是 ， 其 余 也 都 是 有 效 的 。 作 为 动态 稳定 裕 度 ，Ssw 和 Sesw 无 效 。 当 四 
足 步 行 机 器 人 横 过 水 平地 形 时 ， 机 器 人 的 惯性 是 重要 的 。Srssw 和 Sues E I 


表 2.1 稳定 裕 度 分 类 


不 平坦 地 形 | 机 器 人 动力 | 操纵 动力 pam 


否 

是 

是 

否 
eas 
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图 2..14 


[tC SRatcu) —2( SB) 1/s 


1 
tm =7.42 
t/s 


当 在 与 水 平面 成 10" 倾 角 的 地 形 上 ， 以 20N 恒定 的 力 反 向 运动 出 现 惯性 、 
弹性 等 操纵 效应 增加 时 不 同 的 稳定 裕 度 (情况 6) 


—10 —30 


(a) Spsm49 SNDESM 
图 2.15 (一 ) 不 同 地 形 倾角 和 操纵 力 的 最 大 稳定 区 间 
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—10 30 
Cb) SFAsM 与 SNDpESM 
图 2.15 (=) 不 同 地 形 倾角 和 操纵 力 的 最 大 稳定 区 间 


的 测量 量 ， 但 其 余 的 动态 稳定 裕 度 也 是 有 效 的 。 存 在 其 他 动态 效应 ， 如 操纵 力 和 
力矩 时 ， 无 论 在 水 平 还 是 倾斜 的 地 形 上 ， Tooo 作为 比较 研究 的 结 
R, 6 种 情况 下 只 有 Sim 最 合适 。 本 研究 的 另 一 论 是 ， 对 于 6 种 情况 ， 
Spsm 、Srsw 和 Szmr 的 测量 值 相同 。 

最 后 比较 所 选 裕 度 的 计算 复杂 性 ， 通 过 计算 所 需 的 数学 运算 量 来 进行 比较 。 
表 2.2 显示 了 这 些 运算 量 ， 根 据 在 每 一 步 模拟 所 需 的 加 法 、 乘 法 、 三 角 运 算 和 平 
方 根 计 算 ， 同时 考虑 到 支撑 多 边 形 的 条 边 。 在 这 个 计算 中 ,假设 足 端 反作用 力 
是 已 知 的 。 SrasM 是 最 复杂 的 ， Snpsv 是 动态 裕 度 中 最 不 复杂 的 ， Ssm 是 静态 裕 度 中 
最 不 复杂 的 ， 见 表 2. 2。Swoesum 已 被 证 明 是 每 一 种 研究 情况 都 适用 的 稳定 性 ， 且 
计算 复杂 度 较 小 。 


表 2.2 现 有 稳定 性 标准 的 计算 复杂 度 


2.5 稳定 性 水 平 曲线 


基于 2.2 节 和 2.3 节 中 定义 的 不 同 稳定 裕 度 ， 可 以 控制 机 器 人 COG 轨迹 ， 
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以 保证 给 定 的 稳定 性 水 平 。 为 此 ， 可 以 将 稳定 性 水 平 曲 线 定义 为 COG 位 置 在 机 
体 平面 内 的 等 效 稳定 裕 度 [图 2.16 (a)]， 由 机 器 人 纵向 和 横向 轴 (zx 和 y) 和 
COG 的 位 置 确定 。 以 前 使 用 Sesw 和 Swesv (Hirose 等 ，1998) 定义 了 稳定 性 水 
平 曲线 (Messuri, 1985). 考虑 到 2.4 节 中 的 比较 研究 结果 ， 稳 定性 水 平 曲线 使 
用 Sossv 获 得 ， 其 已 被 证 明 是 最 合适 的 稳定 裕 度 。 稳 定性 水 平 曲线 表达 式 为 
Siprem COG- COG, J =C (2.14) 
其 中 COG, 和 COG, 是 COG 的 坐标 ， 参 照 机 体 参 考 坐 标 系 x -y -x (参见 
图 2.16，C 是 一 个 常数 ) 支撑 多 边 形 和 作用 在 机 器 人 上 的 力 和 力矩 参考 外 部 坐 
PA To- yo- zo 是 已 知 的 。 因 此 ， 要 解 式 (2.14)，Swpvesm 必 须根 据 外 部 参考 坐 
标 系 的 可 变 COG 来 表示 ， 然 后 映射 到 机 体 参 考 坐 标 系 。 


(b) 支撑 多 边 形 在 机 体 平 面 上 的 投影 
图 2.16 四 足 支撑 
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机 体 参 考 坐 标 系 在 外 部 参考 坐标 系 COGn 下 的 初始 位 置 矢量 为 


COG; — (COG po COG jo COG.» 7 (2°15) 


COG 运动 到 任何 不 同 点 ，COG=(COG,. ,COG, ,0) 在 机 体 平 面 上 均 可 以 映 
射 到 外 部 参考 坐标 系 ， 转 化 方程 为 


COG cosa sinasinB = sinacos8 COG no) (COG, 
COG, S 0 cosß —sinB COG, || COG, are 
COG. —sina cosasinB cosacos8 COG: 0 

1 0 0 0 1 1 


式 中 a 一 一 z HA x, 轴 之 间 的 角度 ; 
8B 一 一 y 轴 和 yo 轴 之 间 的 角度 [图 2.16 b]. 

要 解 出 式 (2.14) Snpss 必须 用 可 变 的 COG 坐标 表示 COG. COG. 
COGw， 然 后 通过 式 (2.16) 映射 到 机 体 参 考 坐 标 系 。 因 此 ，SNpssv 需 表达 为 机 
体 坐 标 COG., COG,. 

A (2.14) 的 解析 解 会 产生 复杂 表达 式 。 为 了 表达 不 同 的 情况 和 结果 采用 数 
值 计算 方法 。 四 足 在 其 支撑 相 的 稳定 性 水 平 曲线 如 图 2. 17 和 图 2. 18 所 示 ， 同 时 
考虑 动态 效应 。 足 端 位 置 在 机 体 平 面 上 的 投影 用 突出 的 “十 字 ” 表 示 。 

图 2. 17 为 30N 操纵 力 的 机 器 人 的 稳定 性 水 平 曲线 ， 沿 yo 轴 的 力 和 y。 轴 
20N * m 的 操纵 转 矩 。 机 器 人 保持 静止 ， 合 力 产生 一 绕 过 轴 的 力矩 ， 因 此 临界 平 


0.57- 
4 
S QAF 
K + + 
0.3} 
0.2} 
0.1F 
oF 9 | oS aono 
—0.1- 
—0.2} 
—0.3F 
—0.4- + 中 
y. | = J 
—0.4 —=0:2 0 0.2 0.4 


X./m 
图 2.17 无 初始 动能 的 稳定 性 水 平 曲线 
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面 与 垂直 平面 形成 一 个 角度 PP， 机 器 人 两 侧 平行 于 并 轴 。 由 于 这 种 影响 ， 零 稳定 
性 曲线 从 支撑 多 边 形 转移 。 同 样 ， 操 纵 围 绕 y 轴 的 转 矩 引起 临界 平面 与 垂直 平 
面 之 间 的 角度 ， 机 器 人 两 侧 平行 于 y 轴 。 操 纵 力 和 转 矩 也 可 以 改变 稳定 性 水 平 
曲线 之 间 的 梯度 。 

此 外 ， 绘 制 稳 定性 水 平 曲线 如 图 2. 18 所 示 ， 与 图 2. 17 情况 相同 ， 但 是 当 机 
器 人 运动 时 ， 由 四 条 腿 推动 ， 此 时 vcoc 关 0。 在 这 种 条 件 下 ， 存 在 初始 动能 。 在 
2.18 中 COG 沿 z 轴 以 0.2my/s 的 恒定 速度 移动 。 结 果 是 稳定 性 水 平 曲线 在 x 
方向 被 挤 压 。 因此 当 机 体 移动 时 机 器 人 的 稳定 性 降低 。 


Xe/m 


图 2.18 机 体 速 度 初始 值 为 0.2m/s 的 稳定 性 水 平 曲线 


2.6 结论 


本 章 定义 了 几 个 行走 机 器 人 的 稳定 裕 度 ， 但 其 定义 中 没有 直接 表明 它们 在 不 
同 实际 情况 下 判断 稳定 性 的 适用 性 。 例 如 ， 在 倾斜 的 地 形 上 ， 或 存在 操纵 力 和 力 
和 矩 或 腿 部 摆动 动态 效应 时 的 适用 人性， 

本 章 希 望 解决 现 有 的 稳定 裕 度 缺乏 定量 信息 的 问题 。 为 此 ， 经 过 测量 静态 和 
动态 稳定 裕 度 ， 进 行 了 不 同 静 态 和 动态 情况 下 的 稳定 裕 度 比较 研究 。 通 过 分 析 在 
不 同 的 地 形 平 面 的 6 种 情况 ,使 用 两 相位 不 连续 步 态 的 步行 机 器 人 进行 模拟 研 
究 ， 并 考虑 了 动态 效应 。 这 些 情况 涵盖 了 所 有 腿 式 机 器 人 在 实际 工业 应 用 中 可 能 
发 生 的 场景 。 
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结果 表明 在 6 种 情况 的 稳定 性 研究 中 归 一 化 动态 能 量 稳定 裕 度 是 最 合适 
的 。 此 外 ， 每 种 基于 动量 的 稳定 性 标准 提供 了 相同 的 稳定 裕 度 。 对 所 选择 的 裕 
度 在 其 计算 复杂 性 方面 也 进行 了 比较 ， 以 使 每 个 实际 应 用 都 能 选择 适当 的 稳定 
TER E. 

对 于 在 倾斜 地 形 的 不 同 动态 工 况 下 的 机 器 人 ， 使 用 适当 的 稳定 裕 度 ， 获 得 了 
稳定 性 水 平 曲 线 。 稳 定性 水 平 曲线 计算 可 以 控制 COG 的 位 置 在 机 体 平面 内 ， 以 
达到 一 定 的 稳定 性 水 平 。 对 于 给 定 应 用 场景 ， 正 确 地 选择 稳定 裕 度 和 用 于 步 态 控 
制 的 稳定 性 水 平 曲 线 ， 在 步行 机 器 人 任务 生成 中 至 关 重 要 。 
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3.1 简介 


对 腿 部 运动 的 最 初 研究 聚焦 在 观察 、 理 解 和 公式 化 自然 界 中 发 现 的 通用 步 
态 。 这 些 步 态 的 特点 是 腿 运 动 顺序 和 立足 点 是 周期 性 的 ， 并 且 机 体 恒 速 运动 ， 所 
有 的 腿 同 时 移动 ， 因 此 被 称 为 连续 步 态 。 波 浪 步 态 是 一 种 特殊 的 连续 步 态 ， 哺 乳 
动物 和 昆虫 在 低速 下 用 波浪 步 态 通 过 平滑 、 不 规则 的 地 形 。 连 续 波 浪 步 态 已 被 广 
泛 研 究 。1968 一 1989 年 (McGhee 和 Frank, 1968; Zhang 和 Song, 1989) 用 一 
个 数学 公式 模型 来 描述 腿 序列 ， 衍 生 推 导出 蟹 行 步 态 和 圆 弧 步 态 ， 但 只 适用 于 平 
坦 的 地 形 条 件 。 这 些 步 态 的 理论 结果 是 显著 的 ， 但 不 适用 于 在 不 平坦 的 地 面 上 行 
走 的 步行 机 器 人 。 因 此 ， 有 人 试图 将 这 些 步 态 应 用 于 不 规则 的 地 形 条 件 (Kumar 
和 Waldron, 1989; Jimenez 和 Gonzalez de Santos, 1997). 

当 由 于 地 形 不 规则 和 陡峭 ， 哺 乳 动物 和 昆虫 不 能 保持 连续 步 态 时 ， 可 以 将 步 
态 变 为 更 安全 的 步 态 。 这 种 步 态 的 特征 是 腿 和 机 体 的 顺序 运动 。 机 体 是 向 前 /向 
后 推动 时 ， 所 有 的 足 固 定 在 地 面 上 ， 一 条 腿 与 其 他 三 条 腿 一 起 转移 时 ， 机 体 停 
止 ;， 这 种 步 态 称 为 不 连续 步 态 。 机 体 间 歇 性 运动 有 益 于 真正 的 步行 机 器 : 它们 更 
容易 实现 ， 而 且 提供 比 波浪 步 态 更 好 的 纵向 稳定 裕 度 ; 另外 ， 通 过 一 些 步 态 参数 
设置 ， 可 以 比 波浪 步 态 速度 更 快 ; 而 且 ， 腿 部 依次 移动 适合 在 非常 不 规则 的 地 形 
行走 ， 因 为 每 个 移动 的 腿 与 地 面 接触 前 ， 其 余 的 腿 和 机 体 均 不 动 。 因 此 这 些 步 态 
有 具有 潜在 的 地 形 适 应 性 。 

不 连续 步 态 的 研究 始 于 20 世纪 90 年 代 。 这 种 步 态 首先 在 野外 机 器 上 实施 ， 
如 卡 内 基 梅 隆 大 学 开发 的 AMBLER AMBLER 有 一 个 特殊 的 不 连续 步 态 ， 称 为 
AIEA (Bares 和 Whittaker，1989)。 圆 弧 步 态 是 由 机 器 的 特定 拓扑 结构 而 产 

生 的 。 到 20 世纪 90 年 代 中 期 ， 适 用 于 哺乳 动物 或 类 昆虫 机 器 人 构 型 的 不 连续 步 
态 是 基于 波浪 步 态 创建 的 (Gonzalez de Santos 和 Jimenez, 1995). 

对 于 具有 不 可 行 区 域 的 地 形 ， 例 如 大 孔 、 突 起 或 诸如 地 雷 等 危险 区 域 ， 周 期 
步 态 可 能 会 遭 到 破坏 并 变 为 男 一 种 步 态 ， 即 根据 地 形 条 件 在 线 选择 立足 点 和 动作 
序列 ， 这 种 步 态 称 为 非 周期 性 步 态 ， 也 称 为 自由 步 态 。 因 此 步 态 可 以 分 为 周期 性 
和 非 周 期 性 两 大 类 。 不 同 的 运动 状态 ( 抬 腿 、 足 放置 和 机 体 运动 ) 发 生 在 步 态 周 
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期 的 相同 时 刻 ， 则 步 态 是 周期 性 的 。 另 外 ， 通 过 观察 机 体 运 动 ， 有 些 步 态 以 恒定 
速度 移动 机 体 〈 连 续 步 态 ) ， 有 些 步 态 间歇 地 移动 机 体 (不 连续 步 态 )。 以 上 为 书 
中 用 到 的 主要 步 态 分 类 。 更 详细 的 分 类 可 以 在 Song 和 Waldron (1989) 的 论述 
中 查阅 。 

本 章 介绍 了 周期 性 步 态 的 构想 ， 即 连续 GOR) 步 态 和 不 连续 步 态 。 非 周期 
性 步 态 将 在 下 一 章 进行 研究 。 除 了 数学 推导 ， 两 种 步 态 在 稳定 性 、 速 度 和 可 实现 
性 进行 了 比较 。3.2 WA 3. 3 节 提 出 连续 步 态 。3. 4 节 介 绍 不 连续 的 周期 性 步 态 
及 其 特点 ， 以 及 与 连续 步 态 的 比较 。3.5 节 和 3. 6 节 计 算 不 连续 的 蟹 行 步 态 和 不 
连续 的 转弯 步 态 。3.7 节 提 出 了 如 何 组 合 步 态 以 遵循 预 设 的 路 径 轨 迹 。3. 8 节 为 


结论 。 
3.2 步 态 生 成 


在 英语 中 ， 步 态 被 定义 为 步行 移动 的 一 种 方式 或 方法 。 在 腿 部 运动 领域 ， 步 
态 被 定义 为 足 部 位 置 重 复 的 模式 (Todd，1985)。Song 和 Waldron 描述 得 更 精 
确 (1989): 

定义 3.1 步 态 是 通过 定义 每 只 足 抬升 和 放置 的 时 间 和 位 置 ， 同 时 辅 以 机 体 
的 6 自由 度 运动 ， 以 便 将 机 体 从 一 个 地 方 移动 到 另 一 个 地 方 。 

由 McGhee 和 Frank 第 一 次 尝试 仅 对 于 四 足 定义 步 态 数学 模型 (McGhee, 
1968; McGhee 和 Frank，1968) 。 研 究 人 员 试 图 发 现 一 种 能 够 保持 静态 稳定 四 足 
步 态 。 对 于 这 项 研究 ，McGhee 引入 了 事件 序列 。 事 件 定 义 为 足 放 置 或 足 抬 起 。 
对 于 一 个 有 nn 条 腿 的 机 嚣 人， 是 的 放置 由 事件 i 表示 ,而 足 i 的 抬升 由 事件 i 十 
RR. AM, HERRA 2-4-5-7-3-1-8-6 的 事件 序列 ,创建 2n 个 不 同 
的 事件 。 如 果 两 个 事件 发 生 在 同一 时 刻 ， 步 态 称 为 奇异 步 态 ， 即 不 是 完全 有 序 的 
步 态 ， 或 非 奇 异 的 步 态 。 可 能 的 非 奇异 四 足 步 态 的 数量 是 2” 个 事件 的 排列 ， 即 
数量 是 22!。 考 虑 从 给 定 的 事件 序列 开始 的 事件 序列 的 数量 ， 其 结果 是 N= 
(22 一 1)1。 对 于 四 足 N=5040 (McGhee, 1968). 

N 表示 足 部 事件 的 可 能 排列 次 数 。 然 而 ， 为 了 维持 静态 稳定 性 ， 机 器 人 必 
须 至 少 保持 3 条 腿 支 撑 ， 即 只 有 1 条 腿 在 摆动 。 这 意味 着 在 腿 i 抬升 之 后 (事件 
itn) 腿 的 放置 必须 发 生 (事件 让 。 这 个 特征 将 稳定 组 合 的 数量 减少 到 N= (n 一 1)1， 
对 于 四 足 结 果 仅 产生 6 个 事件 序列 ， 如 图 3.1 (b) 所 示 ， 并 在 图 3.1 (c) 一 图 
3.1 (h) 中 示 出 。 在 这 个 例子 中 ， 运 动 循 环 开始 于 足 4 的 运动 。 腿 数 在 图 3.1 (a) 中 
示 出 。 将 腿 从 前 到 后 编号 ， 通 常 将 右 腿 记 为 偶数 ， 左 腿 记 为 奇数 。 

Tomovic (1961) 将 一 个 nn 腿 机 器 人 每 个 支持 模式 至 少 涉及 nn 一 1 个 接触 点 
WE ASE MAMET AAS. Ale, ER 3. 1 PHS RITA: 总 是 有 3 个 足 在 
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O 序列 (1-4-2)/(2-3-1)(g) 序列 1-2-4-3 (h) 序列 1-4-3-2 


图 3.1 四 足 步 态 


支撑 。 疏 行 步 态 可 以 是 奇异 或 非 奇 异 的 。 奇 异步 态 是 非 奇 异步 态 的 极限 状态 。 因 
此 ， 图 3. 1 中 的 事件 序列 适用 于 奇异 和 非 奇异 步 态 。 在 这 种 情况 下 ， 一 个 奇异 步 
态 意味 着 一 个 足 的 放置 和 下 一 条 腿 的 抬升 发 生 在 序列 中 的 同一 时 间 。 

在 这 项 研究 的 几 年 后 ，Hirose 等 (1986) 发 现 这 6 个 事件 序列 可 以 应 用 于 
四 足 转弯 步 态 的 实现 。 它 们 分 为 士 zx 型 、 士 y 型 (分 别 用 于 沿 zx 和 y 轴 的 运动 ) 
Alto 型 (用 于 围绕 = 轴 旋 转机 体 的 步 态 ) ， 其 中 “十 ”表示 向 前 运动 , “一 ” 表 
示 反 向 运动 [图 3.1 (c) 一 图 3.1 w]. 

McGhee 和 Frank (1968) 研究 了 6 种 静态 稳定 的 仆 行 步 态 的 定义 ， 并 表明 
最 佳 静态 稳定 裕 度 是 通过 一 个 规则 〈 每 个 支撑 足 按 相同 的 相位 ) 的 、 奇 异 的 十 z 
MT EA KEAN [图 3.1 (f]。 这 种 爬行 步 态 有 时 称 为 缓慢 爬行 步 态 。 这 是 
一 种 独特 的 步 态 ， 用 于 四 足 低速 移动 ， 因 此 被 称 为 标准 步 态 。 请 注意 ,缓慢 和 候 行 
步 态 没有 一 般 的 定义 ,但 是 对 于 四 足 机 器 人 来 说 缓慢 有 候 行 步 态 与 息 行 步 态 是 同 
Sin. 
在 20 世纪 70 年 代 初 ，Bessonov 和 Umnov (1973) 通过 对 六 足 机 器 人 的 研 
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究 工作 也 得 出 同样 的 结论 。 他 们 通过 数值 试验 发 现 一 个 具有 周期 性 、 规 则 性 、 对 
称 性 〈 任 何 左右 两 侧 成 对 的 事件 恰好 相差 半 个 周期 ) 的 步 态 ， 其 具有 最 佳 静态 稳 
定性 。 四 足 机 器 人 采用 这 种 步 态 时 ， 足 由 后 向 前 运动 迈步 ， 在 机 体 每 一 侧 都 有 一 
系列 的 迈步 ， 使 任何 左右 成 对 的 事件 偏 移 一 半 的 步 态 周期 。 由 于 这 种 步 态 的 腿 部 
波浪 式 的 运动 ， 因 此 称 为 波浪 步 态 。 对 四 足 机 器 人 的 这 种 步 态 在 下 一 节 解释 。 


3.3 连续 步 态 


本 节 介 绍 波浪 步 态 ， 连 续 步 态 最 广泛 应 用 于 自然 和 四 足 机 器 人 。 定 义 时 ， 假 
定 使 用 无 质量 腿 的 理想 机 器 (第 2 章 )。 步 态 定义 如 下 : 

定义 3.2 腿 i 的 占 空 系数 B; 是 该 腿 处 于 支撑 相 的 时 间 与 步 态 周期 的 比 。 如 
RAA BRAY A: 相同 ， 则 步 态 是 规则 的 。 

定义 3.3 腿 i 的 相位 #$, 是 腿 i 放置 落后 于 腿 1 的 放置 的 归 一 化 时 间 OR 1 
通常 被 认为 是 参考 腿 ) 。 

定义 3.4 步 幅 尺 是 足 在 支持 相 相 对 机 体 移动 的 距离 。 尺 必须 在 由 R, MR, 
定义 的 腿 部 工作 空间 内 。 

定义 3.5 步 幅 间距 P 是 相 邻 腿 步 幅 中 心 之 间 的 距离 。P, 是 相 邻 腿 步 幅 中 
心 之 间 的 距离 ，P, 是 对 侧 腿 步 幅 中 心 之 间 的 距离 (图 3. 2)。 

定义 3.6 步 态 的 步 长 人 是 机 体 的 重心 COG 在 一 个 步 态 周期 中 所 移动 的 距 
离 。 如 果 步 态 是 周期 步 态 ， 则 


G31) 


图 3.2 步 幅 定义 示意 图 
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通过 以 上 定义 ,假设 腿 部 工作 空间 不 重 倒 ， 即 RSP, Hr 型 波形 步 态 定 
义 为 


(3. 2) 


其 中 下 是 分 数 函 数 。 

定义 3.7 定义 实数 X 的 分 数 函 数 Y 一 F(X) 为 
X 的 分 数 部 分 (X20) 
人 
McGhee 和 Frank (1968) Æ 2.2 节 证 明了 波浪 步 态 的 SLam 是 最 优 的 ， 即 


sum=(p- 主 (¥<p<1) (3.4) 


(3. 3) 


st (3.4) th, F< p< 是 维护 静态 稳定 的 必需 条 件 。 每 条 腿 的 支撑 相 至 少 


为 3/4 步 态 周 期 ， 对 于 一 个 波浪 步 态 ， 在 任何 给 定 的 时 间 内 至 少 有 3 条 腿 处 于 支 
撑 相 。 式 (3. 2) 可 以 通过 使 用 步 态 图 更 好 地 理解 。 步 态 图 是 描绘 足 接触 地 面 或 
在 空中 〈 由 虚线 表示 ) 的 时 间 的 方法 (由 实 线 表示 )， 还 可 显示 腿 支 撑 和 摆动 变 
化 的 时 间 。 实 线 部 分 的 起 点 是 足 放 在 地 上 的 时 刻 , 终点 是 腿 抬升 的 时 刻 。 图 3. 3 
所 示 为 四 足 机 器 人 的 波浪 步 态 图 ， 记 录 了 抬 腿 和 放 腿 序列 ， 以 及 腿 支 撑 相 和 摆动 
相 的 持续 时 间 。 

考虑 到 波浪 步 态 是 对 称 的 ， 步 态 的 定义 可 以 通过 定义 机 器 人 的 一 侧 腿 部 相位 
来 简化 。 对 于 另 一 侧 ， 腿 部 相位 增加 半 周 期 时 间 。 负 总 是 定义 为 零 。 因此， 六 足 
动物 的 波浪 步 态 可 以 定义 为 


Sun (1974) 归纳 了 这 个 方程 ， 即 一 个 2” 条 腿 机 器 人 的 波浪 步 态 定义 为 
加 ,一 下 (DB) (m=1,2, 1 <e<1 | (3. 6) 


Zhang 和 Song (1989) 定义 了 波浪 转弯 步 态 和 旋转 步 态 。1990 年 ， 他 们 还 
mE Lf EFT AE AS (Zhang 和 Song, 1990). 在 蟹 行 步 态 中 ， 机 器 人 机 体 的 移动 线 
与 机 体 的 纵向 轴线 形成 恒定 的 蟹 行 角 。 这 些 方 程 衍生 于 四 足 ， 并 形成 了 步行 机 器 
人 的 波浪 步 态 。 本 章 不 包括 这 些 步 态 的 描述 ， 但 鼓励 感 兴趣 的 读者 学 习 参 考 文献 
中 的 材料 。 后 文 将 只 关注 不 连续 步 态 。 
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ee ante oa, pr el Tg a See A hn ee i are a my ms 

腿 B=3/4 

1 a 1 
1:=0 | I | | 
| | | | | 

3 en es i 一 一 一 一 一 一 一 | 
| | | jts=B | 

2 a 一 一 一 一 一 一 一 一 | | 
| | | $, =1/2 | | 
| | | | | 

4. (eS eee Se ee a a 
a $,=F (g—1/2) =1/4 i 

时 间 归 一 化 为 周期 工 
(a) p= 
pE 


| 
| 


心 
| 
| 
| 
| 
| 


时 间 归 一 化 为 周期 工 
(b) B= 三 


图 3.3 四 足 机 器 人 的 波浪 步 态 图 


3.4 不 连续 步 态 


不 连续 步 态 的 特征 在 于 腿 和 机 体 的 运动 顺序 (Gonzalez de Santos 和 Jimenez, 
1995)。 一 条 腿 被 摆动 ， 所 有 其 他 腿 处 于 支撑 并 停止 。 在 所 有 腿 支 撑 的 同时 ， 机 
体 移动 ， 此 时 足 端 位 置 不 变 . 

生成 四 足 的 不 连续 周期 性 步 态 时 ， 应 该 考虑 以 下 问题 : 

(1) 如 果 一 条 腿 在 支撑 相 可 达到 工作 空间 的 后 运动 极限 ， 这 条 腿 应 该 转换 成 
摆动 相 ， 并 放置 在 其 前 运动 极限 。 

(2) 机 体 向 前 移动 ， 所 有 的 腿 都 在 地 面 上 上 。 机 体 向 后 运动 时 ， 至 少 有 一 条 腿 
应 该 保持 在 其 后 运动 极限 ， 才 能 执行 摆动 相 进 入 下 一 个 腿 部 运动 。 

(3) 当前 摆动 腿 的 对 侧 不 相 邻 的 腿 CCNA) 应 该 在 该 摆动 腿 放 置 之 后 放置 。 
COG 停留 在 CNA 腿 与 摆动 腿 连 接线 的 另 一 侧 〈 图 3. 4) ,这样 才 可 以 抬 起 另 一 条 
腿 ， 同 时 保持 机 体 的 稳定 性 。 

(4) 腿 的 序列 应 该 是 周期 性 的 ， 以 便 通过 若干 步 态 周 期 的 组 合 跟随 路 径 

在 本 节 中 ， 机 体 采 用 步 态 沿 着 纵向 工 轴 移 动 ， 并 且 保 证 机 体 的 静态 稳定 性 。 
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腿 3 摆动 腿 1 摆动 
b) 相位 2 
图 3.4 两 相 不 连续 步 态 的 连续 步 态 模式 


这 意味 着 COG 的 垂直 投影 总 是 在 支撑 多 边 形 内 部 。 采 用 Sisw 纵 向 稳定 裕 度 进行 


3.4.1 两 相 不 连续 步 态 


从 3.2 节 已 知 ， 四 足 机 器 人 有 41 个 不 同 的 非 奇 异动 作 序 列 ， 这 些 序列 必须 
与 腿 部 位 置 相 结合 定义 稳定 的 步 态 。 可 行 的 解决 方案 非常 多 。 为 了 减少 数量 ， 找 
到 一 个 使 机 器 人 稳定 的 序列 ， 需 要 考虑 一 些 其 他 限制 。 假 设 1 是 每 个 周期 有 一 定 
数量 的 机 体 运动 。 首 先 假设 两 个 机 体 运 动 循环 即 两 相 。 在 这 种 情况 下 ， 两 条 腿 在 
每 相 结束 后 必须 在 其 运动 空间 后 部 ， 这 些 腿 将 顺序 地 向 它们 的 前 运动 极限 摆动 。 
因此 ， 每 条 腿 都 会 移动 其 步 幅 的 长 度 ， 足 点 放置 的 数量 急剧 减少 。 假 设 腿 按 照 在 
图 3.1 O 所 示 的 标准 步 态 序列 摆动 ， 即 后 腿 先 摆动 ， 然 后 前 腿 摆 动 ， 在 这 些 
腿 部 运动 之 后 ， 机 体 向 前 推进 了 一 半 。 在 这 个 动作 结束 时 ， 所 有 没有 移动 的 腿 必 
须 位 于 它们 的 后 运动 极限 。 要 完成 上 述 动作 ， 这 些 腿 需 要 留 在 身体 运动 之 前 的 工 
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作 空 间 中 ， 即 那些 点 是 其 他 两 条 腿 现在 所 在 的 点 的 对 应 点 。 图 3.4 显示 4-2-B- 
3-1-B 的 运动 序列 ， 是 不 连续 步 态 ， 是 后 续 研究 的 基础 。B 代表 机 体 运动 事件 。 
地 球 参考 系 (2, y) 有 助 于 说 明 每 个 腿 和 机 体 运 动 引 起 的 COG 的 绝对 移动 量 。 
1. 不 连续 步 态 的 纵向 稳定 裕 度 
纵向 稳定 裕 度 Sism (2.2 W) 由 两 个 对 侧 不 相 邻 的 足 的 连 线 确定 ， 如 图 3. 4 
所 示 。 对 于 图 3. 4 中 的 所 有 情况 ， 对 角 线 是 从 其 工作 空间 中 间 的 一 个 足 到 达 最 接 
近 COG 的 运动 学 极限 的 足 。 如 图 3.4 所 示 ， 纵 向 稳定 裕 度 (COG 的 投影 和 沿 x 
轴 的 对 角 线 之 间 的 距离 ) 对 于 所 有 情况 都 是 相同 的 ， 其 值 由 在 原点 对 角 线 横 坐 标 
的 绝对 值 给 出 。 当 腿 4 处 于 摆动 相 时 ， 其 值 为 
Susw = (3.7) 
其 中 (rsy) 和 (zs,ys) 是 对 角 线 的 端点 ， 即 定义 对 角 线 足 的 位 置 。 在 摆动 
相 的 腿 4 的 这 些 点 的 值 ， 即 构成 图 3. 4 中 第 一 个 机 器 人 的 姿势 ， 是 (—P,/2, P,/2) 
和 (P,/2—R,/2, —P,/2), HPP, 是 x 轴 方向 的 步 幅 间距 ，P, Æ y 轴 方 向 的 
步 幅 间距 ，R, AR, 是 腿 部 工作 区 尺寸 ， 这 就 定义 了 步 幅 (参见 图 3. 2 参数 定 
义 )。 将 这 些 值 代入 式 (3.7) 得 
Sim, = E (3. 8) 


四 足 机 器 人 波浪 步 态 的 纵向 稳定 由 式 (3.4) 给 出 ， 其 中 4 由 式 (3.1) Æ 
X., 把 式 (3.1) RAK 3.4) 得 出 用 于 波浪 步 态 的 Sism 为 

Siow, = (0-4) (¥<p<1 (3. 9) 

因此 假定 Sim (AE AR, /4 之 间 ， 而 不 连续 步 态 Susw, 恒定 为 R,/4。 因 


此 ， 不 连续 步 态 具 有 比 波浪 步 态 更 大 的 纵向 稳定 裕 度 ， 如 图 3.5 所 示 ， 表 明 
Srsu 正 比 于 步 幅 R,。 这 是 不 连续 步 态 的 主要 优势 。 接 下 来 将 研究 对 速度 的 影响 。 


0 0.8 0.9 


1.0 
占 地 系数 


图 3.5 波浪 步 态 (KR) 和 不 连续 步 态 (虚线 ) 的 Sis 
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2. 两 相 不 连续 步 态 的 速度 
执行 不 连续 步 态 机 器 人 的 平均 速度 由 步 幅 R. 和 周期 了 确定 。 在 不 连续 步 态 
中 ,周期 由 每 条 腿 的 子 相 时 间 和 机 体 运 动 时 间 的 总 和 确定 。 考 虑 到 足 的 摆动 描述 
了 在 一 个 垂直 平面 矩形 轨迹 的 循环 时 间 ，Tm 为 
Tp =4(t Htr ttp) + 2tpp 
sit, BEHA FT AY Tal ; 
tt 一 一 和 腿 向 前 运动 时 间 ; 
tp 一 一 腿 放置 时 间 ，; 
tap 一 一 每 个 子 相 的 机 体 推 进 时 间 。 
ERIAN h, EAIN R., x 和 x 轴 足 端的 速度 分 别 为 V. 和 V.， 则 
Tp 为 


(3. 10) 


a ee oe Re _ 8hV.+5R,V. 
To (P+ +2 he VV. 


在 连续 步 态 中 ,一 个 步 态 周 期 中 一 条 腿 的 支撑 相 时 间 是 = pT, F Bh AHR 
间 为 .二 (1 一 8)Tc， 其 中 Tc 是 步 态 周期 。 考虑 到 连续 步 态 与 不 连续 步 态 的 足 端 
具有 相同 的 轨迹 ， 足 的 摆动 相 时 间 为 


D= 


2h 
Ve 


Ra 
ve 
因此 


„oi fak fe 
r=) (3.11) 


式 (3.10) 和 式 8.11) 表示 了 每 种 步 态 的 步 态 周期 。 因 此 ， 要 计算 步 态 速 
度 ， 还 应 已 知 机 体 一 次 运动 时 循环 的 位 移 。 这 个 位 移 对 于 波浪 步 态 是 1， 对 于 不 
连续 步 态 是 R.; 因此 ， 连 续 (波浪 ) 步 态 的 速度 ve 和 不 连续 步 态 速度 vb 分 别 为 


24. 40 per. 
wT Bh ERY. 


Re RVV 
wT C3. 13) 


AETHER, BRE V.=V.=V, h=R,/K. ERAT. 图 3. 6 所 示 为 四 
足 机 器 人 两 种 步 态 的 速度 ， 归 一 化 V 是 占 地 系数 8 和 参数 天 的 函数 ，K RBA 
ALR 之 间 的 关系 。 从 图 3. 6 可 知 ， 不 论 任 何 K 值 ， 占 地 系数 较 小 时 ， 波 浪 步 态 
的 速度 大 于 不 连续 步 态 ， 占 地 系数 较 大 时 则 小 于 不 连续 步 态 。 图 3.6 的 曲线 还 验 
证 了 vo 二 vce。 该 曲线 定义 了 波浪 步 态 与 不 连续 步 态 速度 参数 相同 时 的 边界 。 相 
同步 态 参 数 下 ， 高 占 地 系数 的 波浪 步 态 比 不 连续 步 态 更 慢 、 更 不 稳定 (图 3. 5)。 

这 项 研究 涉及 步 态 最 高 速度 或 最 大 Si sw 的 确定 ; 但 在 选择 合适 的 步 态 时 ， 
还 应 考虑 其 他 的 步 态 特征 。 例 如 ， 如 果 机 器 人 携带 操作 员 或 乘客 ， 则 连续 步 态 比 
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(3. 12) 


部 分 ”步行 测量 和 算法 


不 连续 步 态 


图 3.6 波形 步 态 和 不 连续 步 态 的 速度 


机 体 动作 颠 徐 的 不 连续 步 态 更 舒适 。 

注意 ， 在 这 个 理论 研究 中 ， 采 用 了 用 于 轴 和 机 体 运动 速度 的 矩形 轮廓 ， 这 意 
味 着 无 限 加 速 。 如 果 轴 和 机 体 加 速度 较 高 ， 速 度 和 Sisw 应 接近 理论 值 。 在 这 种 
情况 下 ， 高 加 速度 会 导致 机 器 上 较 大 的 力 从 而 危及 其 稳定 性 。 而 不 连续 步 态 中 ， 
所 有 足 都 在 地 面 上 移动 机 体 ， 因 此 ， 稳 定性 非常 高 。 如 果 机 器 人 旋转 ， 唯 一 不 稳 
定 的 影响 就 是 支撑 边界 的 一 边 。 在 这 种 情况 下 ， 应 该 使 用 第 2 章 提 到 的 动态 稳 
定性 量度 。 

3. 两 相 不 连续 步 态 的 步 态 图 

图 3.7 所 示 为 两 相 不 连续 步 态 和 波浪 步 态 的 步 态 图 。 同 时 显示 腿 的 子 相 和 机 
PAGE Bh, 这 个 图 的 形状 与 带 有 如 下 占 地 系数 的 波浪 步 态 的 步 态 图 形状 相同 ， 


_ 8h/V+3hK/V 
A T0n/V-+4aK/V 


(3. 14) 


X4 K=2 ił, B=7/9. 

注意 ， 步 态 图 显示 了 腿 部 提供 支撑 以 及 腿 部 摆动 的 时 刻 。 此 外 ,在 波浪 步 态 
中 ， 机 体 连续 移动 经 过 的 时 间 可 通过 机 体 移动 距离 与 步 幅 * 归 一 化 。 而 对 于 不 连 
续 步 态 ， 机 体 在 两 个 间隔 之 间 动 作 ， 因 此 移动 距离 与 机 体 运 动 的 数量 成 正比 。 本 
节 中 的 波浪 步 态 与 非 连 续 步 态 之 间 的 比较 是 基于 相同 的 步 态 图 进行 的 ， 如 图 3.7 
所 示 。 注 意 ， 步 态 图 应 该 以 办 二 0 作为 步 态 [图 3.7 (b)] 的 开始 。 然 而 ， 不 连 
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时 间 归 一 化 为 周期 T 
(a) 不 连续 步 态 


时 间 归 一 化 为 周期 T 
Cb) 波浪 步 态 


图 3.7 两 相 不 连续 步 态 和 波浪 步 态 的 步 态 图 (8 二 7/9) 


续 步 态 [图 3.7 a] 的 步 态 图 从 腿 4 转移 开始 的 。 尽 管 在 已 绘制 的 图 中 所 示 有 
一 点 延迟 ， 但 在 两 种 情况 下 步 态 图 是 相同 的 。 


3.4.2 四 相 不 连续 步 态 


如 上 所 述 ， 为 了 产生 有 效 的 不 连续 步 态 ， 在 开始 摆动 相 之 前 需要 将 腿 定 位 在 
其 后 部 运动 极限 。 对 于 两 相 步 态 ， 每 次 机 体 运动 后 ， 两 条 支撑 腿 都 放置 在 其 运动 
极限 的 末端 。 同 理 也 可 以 生成 这 样 的 步 态 ， 当 一 个 周期 结束 ， 只 有 一 条 腿 停 留 在 
其 运动 极限 的 末端 。 这 需要 每 个 周期 执行 4 次 机 体 运动 (4 个 阶段 )， 因 为 每 一 
次 机 体 运 动 ， 只 有 一 条 腿 处 于 其 运动 极限 的 末端 。 

这 个 步 态 的 步 态 图 有 点 类 似 于 两 相 步 态 图 ， 但 每 次 机 体位 移 在 每 条 腿 运 动 结 
束 时 增加 两 个 额外 的 位 移 。 这 个 步 态 的 速度 与 两 相 步 态 是 相同 的 ， 因 为 时 间 和 总 
位 移 相 等 。 这 种 步 态 的 Sisw 为 


Sis, = 3. 15) 
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因此 ，Sism, 比 式 (3. 8) 两 相 步 态 的 Sisu 差 。 

当 相 数 增加 时 ， 即 单 次 腿 部 运动 、 多 次 机 体 运动 时 ，Sisu 变 差 ， 而 平均 速度 
保持 不 变 。 总 之 ， 两 相 不 连续 步 态 提 供 了 任何 不 连续 步 态 的 最 佳 SLsw， 而 速度 
不 取决 于 相 数 。 


3.5 ”两 相 不 连续 的 得 行 步 态 


不 连续 的 蟹 行 步 态 涉及 改变 足 端 位 置 并 移动 机 体 ， 使 其 运动 方向 保持 与 机 体 
纵 轴 定义 的 蟹 行 角度 一 致 。 为 产生 两 相 不 连续 的 蟹 行 步 态 (ITPDC)， 使 用 与 上 
述 相同 的 腿 部 和 机 体 运 动 序列 ， 即 标准 步 态 的 序列 ， 但 腿 和 机 体 轨迹 发 生变 化 。 
足 端 位 置 如 图 3. 8 所 示 。 腿 部 和 机 体 运 动 改 变 Sim; 因此 ， 机 器 人 有 最 大 的 蟹 
行 角 。 执 行 蟹 行 步 态 的 不 同 可 能 性 取决 于 初始 腿 部 位 置 。 


ee ee j_---_, 一 一 初始 工作 空间 
-一 -第 一 阶段 结束 时 的 工作 空间 


| Eee a ARE cee 


腿 的 工作 空间 


COG 工作 空间 


图 3.8 两 相 不 连续 蟹 行 步 态 的 立足 点 和 工作 空间 


3.5.1 初始 位 置 无 变化 的 TPDC HA 


蟹 行 步 态 的 一 般 公 式 计算 需要 遵循 指定 的 蟹 行 角度 轨迹 的 足 端 位 移 。 显然 ， 
新 的 足 端 位 置 必须 位 于 腿 部 工作 区 内 ， 且 腿 执 行 尽 可 能 大 的 迈步 ， 将 立足 点 放 在 
工作 空间 边界 。 因 此 ， 沿 着 y 轴 的 足 的 放置 将 被 限制 在 其 最 大 值 , 由 | R,/2 | 
ih, Wa 轴 的 位 移 将 与 y 轴 位 移 相 关 。 图 3. 9 说 明了 两 种 可 能 的 情况 。 步 幅 或 
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足 的 位 置 增 量 的 分 量 L, ML, 定义 为 


情况 A: 
L,=R 
(|Rtanal <) 
L,=R, tana 2 
情况 B 
= R, 
Es | 2 cota 


(IR. tana | > 学 | 


L, 。 服部 工作 空间 


图 3.9 不 连续 蟹 行 步 态 的 足 的 轨迹 
(情况 A 和 情况 B) 


图 3. 8 所 示 为 在 情况 A 中 TPDC 步 态 使 用 轨迹 定义 的 工作 位 置 序列 。 对 于 
BEAT fia, fe SRE Ie HA eo) (R, ,Rtana)， 机 体 在 每 个 阶段 移动 [R,/2， 
(R,/2)tana], Al 3. 8 显示 了 确定 蟹 行 步 态 〈( 实 线 ) 和 非 蟹 行 运 动 (虚线 ) 稳定 
裕 度 的 对 角 线 。 第 一 条 腿 的 运动 ， 即 腿 4， 在 两 种 情况 下 (和 钥 行 和 非 蟹 行 步 态 ) 
Sisu 是 相同 的 ; 但 是 当 腿 2 移动 时 ， 对 于 和 蟹 行 步 态 运动 ，Sism 减 小 。 在 机 体 运动 
后 腿 3 移动 ，Sisum 更 低 于 非 稻 行 运动 。 最 后 ， 当 腿 1 BON, Sim AKTIERI 
态 ( 在 图 中 考虑 了 蟹 行 角 )。 

图 3. 10 所 示 为 不 连续 蟹 行 步 态 的 稳定 裕 度 。 其 中 :; Pa 二 0.55pym，P,== 
0.55ym, R,=0. 25um, R,=0.25um, a 取 值 为 一 45" 一 45"。 腿 2 摆动 中 呈现 最 
小 的 Sisu 为 正 蟹 行 角 。 将 腿 的 位 置 值 代入 式 (3.7)， 当 腿 2 在 摆动 过 程 中 ，a 满 
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图 3. 10 不 连续 蟹 行 步 态 的 稳定 裕 度 
足 情况 A 约束 ， 则 稳定 裕 度 为 


s RAP 2P tara) 
Mi 4(P,—R, tana) 


FEMEA, MAPED Susw 时 腿 1 正在 摆动 。 在 这 种 情况 下 ，Sisw 的 
值 为 


(3. 16) 


S _P,R,+2P,R,tana—R? tana 
LSM, — 4P, 


运动 周期 内 的 Stsw, 是 处 于 摆动 相 的 不 同 腿 获 得 的 稳定 裕 度 最 小 值 ， 如 图 
3. 10 中 的 粗 虚线 所 示 。 

UITA a 满足 情况 B 约束 时 ,无论 a 为 正 还 是 为 负 ，Sism 的 表达 式 为 
—P,R,—P,R,+P,R,cota 


RS 


Sism,, = 2x (2P,—R,) (3. 18) 
| 
Sisw = 2P Rs HPN TE, 2P,R,cota (3. 19) 
y 


在 现 有 参数 下 ， 图 3. 10 RFE f a 落 在 一 30 "一 26 范围 内 。 
3.5.2 初始 位 置 变化 的 TPDC 步 态 


为 了 实现 四 足 机 器 人 稳定 地 达到 最 大 蟹 行 角 ， 需 将 支撑 腿 的 足 轨 迹 通 过 工作 
空间 的 中 心 。 这 与 如 图 3. 11 所 示 的 初始 足 位 置 的 放置 等 效 。 
在 腿 2 和 腿 4 摆动 相 之 后 ， 机 体 将 沿 x 轴 和 y 轴 移 动 半 个 步 态 周 期 。 然 后 ， 
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第 3 章 周期 步 态 的 


腿 部 工作 空间 


初始 足 位 置 
图 3.11 不 连续 蟹 行 步 态 的 足 轨 迹 和 初始 足 位 置 


GR 1 和 腿 3 停留 的 位 置 与 腿 2 和 腿 4 开始 循环 时 所 在 的 位 置 相同 ; 因此 ， 这 些 腿 
不 需要 完成 初始 足 端 位 移 。 这 种 步 态 的 初始 腿 部 布置 如 图 3. 11 所 示 。 

L. ML, 定义 为 步 幅 ， 初 始 足 位 移 为 在 机 体 参 考 坐 标 系 中 的 D, 和 了 D,， 其 可 
以 计算 为 

情况 C: 


一 0 (| R,tana|<R, ) 


= 
y “z ang 


情况 D: 
L,=|R,cota| 
L,=sign(a)R, 


ee 


3 (|R,tana|>R, ) 


R 
-> cota 


2 


D= ~ sign(a) 


图 3. 12 所 示 为 右 腿 初始 位 置 变化 时 两 相 不 连续 步 态 的 稳定 裕 度 ， 通 过 足 轨 

迹 定 义 的 Sis 与 a> M4 Q 为 正 时 ， 最 小 Sism 出 现在 腿 2 或 腿 3 处 于 摆动 相 时 ; 当 

a 为 负 时 ， 而 对 应 于 腿 1 和 腿 4。 重 复 3. 5. 1 WHA, 在 每 一 种 情况 下 Sim hK 
达 式 为 

_R,(P,—P,tana) 


Sisme, 一 2(2P,—R, tana) Siae 
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ee es ee ee ee ee Sy A 所 = 


2 
m 
So 


稳定 裕 度 /mm 
© 2 
& 加 

T 


2 
© 
宁 


=50 0 50 
a/C) 


图 3.12 右 腿 初始 位 置 变 化 时 两 相 不 连续 步 态 的 稳定 裕 度 


及 下 Panay 


Sisu- 2X (2P, FR, tana) SRG 
+ — P R; P3R,cota 

SiM ~ 2X (2P, —R,) (3. 22) 

Sisu, = =R; CP, cote Pa) (3. 23) 


2X (2P,—R,) 
图 3. 12 中 ， 步 态 周 期 的 Siswe, 以 粗 虚 线 表示 。 情 况 A 和 情况 B 的 Sisv 的 
Sisv 在 虚线 处 已 经 重奏 。 


3.5.3 不 连续 步 态 策略 


本 节 主 要 介绍 如 何 组 合 步 态 来 跟踪 给 定 轨迹 。 在 这 项 研究 中 ， 为 了 简便 ， 在 
机 体 参 考 坐 标 系 中 ， 最初 和 最 后 一 个 循环 的 腿 部 位 置 ， 在 所 有 考虑 的 步 态 中 是 相 
同 的 。 因此 ， 在 步 态 周期 结束 时 ， 组 合 不 同 的 步 态 是 很 简单 的 。 

前 文 已 经 分 析 了 不 连续 蟹 行 步 态 的 不 同方 案 。 两 相 不 连续 步 态 与 零 蟹 行 角 不 
连续 步 态 是 一 致 的 。 步 态 的 选择 和 使 用 取决 于 工作 空间 的 约束 。 图 3. 10 和 图 
3.12 显示 了 每 个 步 态 模式 实现 的 Ssw 和 最 大 秘 行 角 。 且 每 个 图 显示 了 一 种 模式 
下 由 是 轨迹 定义 两 种 不 同 的 情况 。 从 一 个 轨迹 切换 另 一 个 轨迹 发 生 在 曲线 斜率 突 
变 的 点 。 随 着 初始 位 置 的 变化 ，TPDC 比 没有 角度 变化 TPDC 模式 (其 初始 位 
置 限 制 在 一 30 "一 26" 之 间 ) 可 实现 的 蟹 行 角 更 大 〈 一 45 "一 4 ) 。 此 外 ， 人 情况 C 和 
情况 D CARA) 表现 出 比 情 况 A 和 情况 B (虚线 ) 更 大 的 Sisv， 如 图 3. 12 所 
示 。 因 此 ， 初 始 位 置 带 角度 变化 的 TPDC 步 态 呈现 出 更 好 的 SLsu 并 可 实现 更 大 
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的 艇 行 角 ， 但 这 是 以 额外 的 腿 部 动作 为 代价 ， 在 步 态 开始 要 定位 其 右 腿 的 初始 
全 时: 

如 果 机 器 人 从 两 相 步 态 初始 位 置 开 始 镭 行 轨迹 ， 可 以 避免 腿 部 初始 化 问题 。 
在 这 种 情况 下 ， 初 始 运动 及 腿 4 和 腿 2 的 第 一 步 可 以 由 一 个 初始 迈步 代替 。 移 动 
腿 4 和 腿 2， 然 后 从 它们 的 两 相位 初始 位 置 依次 移动 腿 4 和 腿 2 到 情况 C 或 情况 
D 最 终 摆 动 腿 的 位 置 。 图 3. 11 显示 了 这 些 点 和 在 每 种 情况 的 初始 步骤 中 腿 2 和 
腿 4 应 该 跟随 的 轨迹 分 别 为 扔 行 角 a、 和 as)。 当 腿 4 开始 摆动 相 时 ， 剩 下 的 腿 
被 放置 在 不 连续 的 两 相 步 态 保持 点 上 ; 因此 ， 两 个 步 态 Sim 重合; 当 腿 2 开始 
摆动 相 时 ， 剩 下 的 腿 被 放置 在 对 应 于 情况 C 或 情况 D 的 点 处 。 因 此 ， 执 行 此 初 
始 步骤 时 Sisw 不 会 改变 ， 以 避免 腿 部 初始 化 。 

类 似 地 ， 从 短 行 步 态 变 为 两 相 步 态 〈 无 蟹 行 角 )， 需 要 新 的 右 腿 初始 化 ， 但 
可 以 避免 第 一 步 直 接 进入 两 相 步 态 最 终 转移 腿 的 位 置 。 对 于 第 一 步 ， 在 腿 4 摆动 
的 过 程 中 ， 根 据 所 讨论 的 情况 ， 其 余 腿 位 于 它们 在 情况 C 或 情况 D 时 的 位 置 。 
因此 ，Sisu 等 同 于 已 完成 轨迹 的 Sismo HAE 2 改变 为 摆动 相 时 ， 其 余 腿 留 在 它们 
相应 的 两 相 初 始 位 置 上 ; 所 以 对 于 两 相 案 例 Sisw 是 相同 的 。 

综 上 ， 对 于 情况 C 或 情况 D 初始 迈步 的 Sisu 总 是 相等 的 ， 并 且 这 两 种 情况 
都 比 情 况 A 和 情况 B 的 Sisu 大 。 因 此 ， 如 果 机 体 要 跟随 轨迹 运动 至 少 两 个 步 态 
周期 ， 建 议 使 用 情况 C 或 情况 DD 来 执行 初始 和 终止 迈步 。 只 有 当 步 态 周 期 短 于 
两 次 运动 时 情况 A 和 情况 BAA HA. 

上 文 显示 了 从 两 相 步 态 到 甸 行 步 态 运动 变化 时 Siow 的 变化 。 当 机 器 从 和 蟹 行 
步 态 变 成 男 一 种 步 态 时 ， 可 以 以 类 似 的 方式 显示 ， 初 始 迈 步 的 Sis 等 于 两 种 连 
接 步 态 中 较 小 的 Sisu。 


3.6 不 连续 转弯 步 态 


蟹 行 步 态 使 机 器 人 的 机 体 沿 着 直线 轨迹 组 合 不 同 的 稻 行 步 态 ， 使 机 器 轻松 跟 
随 复杂 的 轨迹 成 为 可 能 (3.7 节 )。 但 是 ， 有 时 步行 机 器 人 需要 沿 着 非 直线 轨迹 
并 保持 机 体 与 该 轨迹 相 切 ， 或 使 身体 围绕 其 垂直 轴 旋转 。 执 行 这 些 运动 的 步 态 称 
为 转弯 步 态 。 

典型 的 曲线 轨迹 是 圆 ， 机 器 人 沿 着 这 条 曲线 的 步 态 称 为 圆 形 步 态 。 不 连续 四 
足 圆 形 步 态 ， 像 禾 行 步 态 ，Sisw 与 半径 相关 并 减 小 。 当 机 器 人 的 轨迹 是 一 个 大 半 
径 圆 时 ， 机 体 转 的 角度 较 小 ， 稳 定性 变化 很 小 。 当 圆 半 径 较 小 ， 机 体 转 角 较 大 
时 ， 稳 定性 变化 显著 。 当 半径 为 极限 值 时 ， 机 器 绕 机 身 坐标 系 的 = 轴 旋转 ， 即 零 
转弯 半径 ， 这 种 步 态 也 称 为 旋转 步 态 (Zhang 和 Song，1989) 。 这 两 个 步 态 必须 
分 开 研 究 。 
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3.6.1 圆 形 步 态 


为 了 达到 将 不 同 的 步 态 连接 起 来 跟踪 轨迹 的 目标 ， 在 步 态 周期 中 ， 初 始 腿 位 
置 和 最 终 腿 位 置 在 机 体 参考 坐标 系 中 应 该 是 一 样 的 ， 这 些 位 置 也 与 上 面 讨 论 过 的 
步 态 相同 。 

1. 轨迹 定义 

机 器 人 转向 步 态 的 轨迹 应 为 圆 形 ， 但 为 了 简单 起 见 ， 将 理论 轨迹 近似 为 直线 
段 轨迹 。 因 此 ， 机 体 轨 迹 分 段 组 成 ， 两 端点 位 于 半径 为 R 的 理想 圆 形 轨迹 上 ， 
在 每 个 阶段 结束 时 ， 这 些 分 段 将 跟随 机 体 COG。 这 些 直线 运动 与 机 体 绕 x 轴 旋 
转 结合 ， 以 保持 机 体 纵向 轴线 与 圆 形 轨迹 相 切 。 图 3. 13 所 示 为 一 个 不 连续 圆 形 
步 态 的 机 体 轨迹 。 这 种 方法 描述 的 轨迹 方法 对 于 步行 机 器 的 许多 应 用 是 足够 的 。 


xz?+(y—R)?=R? 


图 3. 13 ”一 个 不 连续 圆 形 步 态 的 机 体 轨迹 


如 果 图 3. 13 所 示 的 坐标 系 y) 是 开始 阶段 的 机 体 参 考 坐 标 系 ， 坐 标 
(zi,y;) 代表 在 当前 阶段 结束 时 机 体 COG 的 位 置 点 。 这 点 由 半径 为 R 的 理想 轨 
迹 的 交点 确定 ， 通 过 

x’? +(y—R)?=R’ (3. 24) 

以 机 体 坐 标 系 的 原点 为 中 心 ， 以 工 为 半径 的 圆周 定义 为 

tyi? 
其 中 工 是 每 段 中 的 机 体位 移 。 
同时 解 以 上 两 个 方程 ， 得 


(3. 25) 


66 


第 3 章 周期 步 态 的 
当 COG 放 在 点 Cry) 上 时 ， 机 体 应 该 旋转 大 约 a 角度 。 此 时 ， 机 体 的 纵 
轴 将 与 轨迹 相 切 并 可 重复 先前 的 过 程 。 
参考 图 3. 13， 有 下 列 方程 式 


B=¢@ 
RH 于 (3. 26) 
2o+a=n 
因此 ， 机 体 旋 转 的 角度 为 
a 一 28 
其 中 
B= arcsin (3. 27) 


这 些 参数 定义 了 机 器 人 的 运动 。 

不 连续 圆 形 步 态 与 不 连续 鳃 行 步 态 的 腿 的 相位 相同 。 这 种 圆 形 步 态 应 满足 两 
个 条 件 。 首 先 ， 腿 部 位 置 必须 靠近 两 相 步 态 位 置 并 保持 稳定 。 其 次 ， 在 一 个 步 态 
周期 开始 和 结束 时 ， 腿 部 位 置 在 机 体 参 考 坐 标 系 中 必须 相同 。 通 过 选择 接近 R,/2 
的 工 来 满足 第 一 个 条 件 ， 这 是 不 连续 零 禾 行 步 态 机 体 在 一 个 相位 中 的 位 移 。 为 
满足 第 二 个 条 件 ， 在 初始 参考 坐标 系 y) 腿 位 置 ， 必 须 放置 在 参考 坐标 系 
具有 相似 部 位 的 位 置 ， 在 步 态 周 期 结束 时 (zs ,ys)。 

在 每 个 阶段 ， 机 体 均 平移 工 = Cry) 并 绕 角度 a 旋转 。 因此, 将 Crys yn) 
FERI oyd) 的 齐 次 矩阵 为 


cosa) — sing 2; 


IAa(ayziyy) 一 | sina cosa y; (3. 28) 
0 0 l 
在 机 体 完成 一 次 步 态 周期 之 后 ， 腿 4 和 腿 2 应 放置 在 机 体 参考 坐标 系 步 态 初 
RAME, B Pos (zos ,yoy》 和 Pos (x02 ,yoz)。 因 此 ， 为 了 计算 在 第 一 参考 坐标 系 
中 的 这 些 位 置 ， 必 须 进行 两 次 齐 次 变换 ， 因 此 ， 腿 的 位 置 变 为 
P, ='Ag (as zis yi) Anlaii s xi, yi)Po 
eo sn etd 
在 这 种 情况 下 ， 机 体 需 要 移动 长 度 工 并 旋转 角度 w 。 这 个 运动 是 通过 移动 立 
足 点 来 实现 的 ， 参 考 坐 标 系 oy) 转换 到 参考 坐标 系 (za,ys)， 这 表明 机 体 
位 置 在 机 体 运动 之 后 。 这 种 机 体 运 动 的 齐 次 转化 为 


BA (asXisyi) = 


(3. 29) 


cosa sina —.2;cosa—y;sina (3. 30) 
"Ay Casi syi) =| —sina cosa Zzising— yicosa 
0 0 1 
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现在 腿 3 和 腿 1 必须 放 在 他 们 的 新 位 置 。 注 意 ， 当 机 体 处 于 第 二 阶段 的 开始 
时 ， 为 了 将 机 体 参 考 坐 标 系 中 的 步 态 初始 位 置 推算 到 参考 坐标 系 中 ， 它 只 需要 执 
行 一 个 变换 'Ap (a,zi,y;)。 当 腿 动 作 序 列 完成 时 ， 机 体 必须 使 用 变换 'AB' Casti yi) 
进行 移动 和 旋转 。 不 连续 圆 形 步 态 的 算法 可 归纳 如 下 : 

(1) 步骤 1: 将 腿 7 放 在 每 个 7 的 初始 位 置 P), 上。 计算 a、z; Myo 

(2) 步骤 2: KR 4 BOE P, ='Ap la, tyi) Agla, Tisy) Pu Eo 

(3) 步骤 3: 将 腿 2 WE P.='Ap(asz;,y;)'Aglasz;sy;)Po 上。 

(4) 步骤 4: 机 体 运 动 ， 将 腿 j 放 在 Pj 二 'AB' (a,zi,yi)P; Vj. 

(5) RES: 将 腿 3 放 在 P;=='As(a,z;,y;)Pos 上 。 

(6) 步骤 6: RB 1 WE P, ='Azpla.z;,y;)Po E 

(7) 步骤 7: Hie, KAR; WEP; ='Ag'(a,z;,y)P)Vj.~ 

2. BEBE 

图 3.14 所 示 为 步行 机 器 的 Stsw ， 不 连续 圆 行 步 态 具 有 与 以 前 示例 相同 的 参 
数 。 腿 3 确定 一 个 步 态 周期 的 Sisw ， 圆 形 半径 小 于 1m 时 机 器 变 得 不 稳定 。 


稳定 裕 度 /m 


图 3. 14 不 连续 圆 形 步 态 的 Ssu 曲线 


在 这 个 步 态 循环 中 ， 应 该 区 分 旋转 角度 的 正 负 ， 由 旋转 矢量 符号 表示 。 腿 的 
相位 与 两 种 情况 类 似 , 但 坐标 取决 于 转弯 角度 的 符号 。 例 如 ,图 3. 13 显示 正 向 
旋转 ，z My, HIE; 但 是 对 于 负 向 旋转 ，y; 为 负 ， 而 z; 为 正 。 右 侧 和 左 侧 的 腿 
的 位 置 不 对 称 ; 因此 ，Sisu 取 决 于 旋转 方向 的 符号 。 在 小 半径 的 圆 弧 下 旋转 角度 
的 影响 很 明显 ， 腿 的 位 置 差异 是 十 分 明显 的 对 于 大 半径 圆周 ， 腿 的 位 置 差异 微 
不 足 道 。 对 于 小 半径 正 圆 周 和 负 圆周 Sisv 曲线 相似 ， 略 有 差异 。 一 个 显著 的 差 
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异 是 处 于 对 角 线 位 置 的 腿 在 摆动 相 获得 的 曲线 相似 。 因 此 ， 负 圆周 Si sua 曲线 由 
腿 2 确定 ， 此 曲线 与 腿 3 正 圆周 的 Stsw 曲 线 相似 。 


3.6.2 旋转 步 态 


上 述 阐明 了 小 半径 圆 形 会 使 步 态 变 得 不 稳定 。 机 器 人 要 执行 小 半径 圆 形 步 
态 ， 腿 相位 序列 必须 改变 。 由 于 圆 形 步 态 不 稳定 半径 的 范围 较 短 ， 因 此 考虑 旋转 
步 态 ， 这 意味 着 围绕 > 轴 的 机 体 旋 转 ， 并 将 该 步 态 视 为 该 范围 的 独特 步 态 。 

1. 相位 序列 

在 以 前 的 步 态 研 究 中 ， 必 须 维持 腿 部 在 步 态 周期 之 后 机 体 坐 标 位 置 相同 。 在 
旋转 步 态 中 也 有 这 一 条 件 。 图 3.15 (a) 显示 了 在 开始 (虚线 ) 和 结束 XR) 
的 第 一 阶段 的 腿 部 位 置 。 第 一 阶段 结束 时 机 器 人 的 腿 部 工作 空间 旋转 a/2. DE 4 
和 腿 2 依次 放置 在 它们 的 位 置 上 ， 然 后 机 体 旋转 ， 但 其 旋转 不 会 将 左 腿 放置 在 第 
一 阶段 结束 的 正确 位 置 〈 与 两 相 不 连续 相同 的 位 置 步 态 ) 。 要 把 这 些 腿 放 在 它们 
的 位 置 上 ， 还 需要 另外 两 个 腿 的 动作 CHR 1 和 腿 3) 。 因 此 ， 在 不 连续 旋转 步 态 中 
一 个 阶段 是 由 4 条 腿 的 运动 决定 ， 而 不 是 2 条 腿 的 运动 ， 如 同 之 前 的 步 态 一 样 。 
注意 摆动 腿 的 立足 点 必须 在 初始 腿 部 工作 区 内 (旋转 机 体 之 前 )。 因 此 ， 腿 部 步 
幅 应 小 于 真正 的 腿 部 工作 空间 。 为 了 澄清 这 一 点 ， 腿 2 实际 的 腿 部 工作 空间 在 图 
3. 15 中 以 实 线 描绘 。 

图 3.15 b) 显示 了 第 二 阶段 的 初始 位 置 〈 实 线 ) 和 最 终 位 置 (虚线 )。4 条 


(a) 第 一 阶段 (>) 第 二 阶段 
图 3.15 不 连续 旋转 步 态 的 步 态 形式 
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腿 必 须 位 于 结束 机 体 旋 转 之 前 的 最 终 位 置 。 

计算 第 一 阶段 结束 时 腿 的 位 置 ， 通 过 应 用 齐 次 矩阵 Da Oz 轴 旋 转 a/2 (0/2, 
0，0) 到 两 相 步 态 第 一 阶段 结束 时 腿 的 位 置 。 一 个 机 体 步 态 周期 通过 的 角度 a 是 
关于 整个 轨迹 旋转 角度 有 的 约 数 ， 即 a 二 B/n， 其 中 是 完成 轨迹 所 需 的 步 态 周 期 
HM. a 应 考虑 稳定 性 。 

在 已 知 的 位 置 ， 必 须 指定 腿 的 序列 来 定义 步 态 。 图 3. 15 的 几何 分 析 显 示 了 
在 这 种 情况 下 普通 的 腿 部 序列 ， 以 前 步 态 中 使 用 的 4-2-3-1 是 不 稳定 的 。 分 
析 4! 个 可 能 序列 ， 可 以 找到 几 个 稳定 的 步 态 。 例 如 ， 腿 序列 3 -4-2-1 对 于 第 
一 阶段 是 稳定 的 ， 腿 序列 1-2-4-3 对 于 第 二 阶段 是 稳定 的 。 这 两 种 腿 序列 将 
在 以 下 部 分 分 析 。 

2. 稳定 裕 度 

图 3. 16 显示 了 上 述 定义 的 旋转 步 态 每 条 腿 在 其 摆动 子 阶段 的 Sismo B— 
段 的 腿 4 呈现 负 向 旋转 最 小 的 Sisw， 对 于 正 向 旋转 ，Sism 在 第 二 阶段 由 腿 2 呈 
现 。 这 两 个 裕 度 决定 了 步 态 周期 的 Sm 〈 沿 完整 步 态 周 期 的 最 小 值 ) ， 如 图 3. 16 
KRR. Legi G) 表示 沿 着 ) 阶 处 于 摆动 相 腿 ; 的 Sisw。 步 态 周 期 的 Sisu H 
粗 虚 线 显 示 ， 粗 点 线 是 减少 腿 部 运动 的 步 态 的 Sismo 

正 负 旋转 步 态 的 Sisw 分 别 为 


a 


P,R,cos 2 —(P?+P?—P,P,)sin 


a 


Sism+ = 2 3 7 2 (3-31) 
4cos 2 (P,cos I Te sin a 
a° 10 
ax 
£ 
ty 
É 
0.05 b 


- 
Ee 
一 
一 
一 
一 
a 
7 
2 
> 
e 
区 
一 
一 
= 
7 
一 
一 
a 
ps 
一 


本 
es 


旋转 角度 /(C) 
图 3. 16 不 连续 旋转 步 态 的 SLsm 
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P Rocas 5 + (Pi +P) PP sina 


SLsM— = (3. 32) 


4cos $(P,cos i z) 

3. 6. 2 节 显 示 了 不 连续 旋转 步 态 可 能 的 稳定 序列 为 3-4-2-1-1-2-4-3， 
即 腿 1 执行 两 次 连续 运动 。 如 果 第 一 阶段 的 腿 1 放置 在 其 第 二 阶段 位 置 ， 则 可 避 
免 额 外 的 动作 。 如 果 旋 转运 动 由 几 个 步 态 周期 组 成 ， 相 同 的 做 法 可 以 应 用 于 腿 
3， 最 后 的 腿 序列 可 以 为 3-4-2-1-2-4。 这 个 新 序列 的 Susv 公 式 为 
_ P R cosa (PtP = PR sina 


Sism,, z p C3: 33) 
4cos =| P,cosa+ P,sin > 
2 my 
为 正 旋转 。 
二 RE 
Sismp 3(P,--P,cosa— P sina) er 
为 负 旋转 。 


图 3. 16 的 虚线 显示 了 减少 腿 部 运动 数量 的 旋转 步 态 Sisw。 但 这 种 步 态 每 一 
个 周期 的 Sion 和 最 大 旋转 角度 都 较 小 。 从 图 3. 16 可 以 得 出 结论 ， 减 少 腿 部 运动 
的 旋转 步 态 适用 于 小 于 士 16 的 旋转 角度 ， 但 对 于 较 大 的 角度 ， 采 用 全 旋转 步 态 
较为 方便 。 注 意 ， 所 有 数据 都 依赖 于 几何 特征 。 


3.7 不 连续 步 态 的 路 径 跟 踪 


考虑 到 不 连续 步 态 的 推导 ， 周 期 性 的 立足 点 允许 关节 连续 运动 来 跟踪 轨迹 。 
本 节 考 虑 使 用 艇 行 步 态 和 转弯 步 态 两 者 来 跟踪 轨迹 。 

研究 人 员 广 泛 研 究 了 轮 式 机 器 人 的 路 径 规划 和 跟踪 ， 并 且 已 经 设计 了 许多 不 
同 的 轨迹 来 增强 机 器 人 的 机 动 性 、 加 速 性 等 。 使 用 6 - Splines, Bezier 曲线 和 
clothoids -平面 曲线 ， 它 的 曲率 是 长 度 的 线性 函数 。 在 本 章 的 方法 中 ， 考 虑 采用 
数值 解决 方案 。 任 何 一 种 数学 函数 都 可 以 用 于 定义 路 径 。 


3.7.1 和 蟹 行 步 态 的 路 径 跟 踪 


不 连续 蟹 行 步 态 的 定义 保证 足 和 COG 的 工作 空间 大 小 相等 ， 腿 部 轨迹 和 
COG 轨迹 相同 并 且 彼 此 平行 。 假 设 COG 在 所 需 的 路 径 上 ， 机 体 的 纵向 轴线 与 参 
考 系统 路 径 zx 轴 对 齐 。 如 果 路 径 由 y= 二 p(x) 给 出 ， 则 应 在 每 个 步 态 周期 中 尽 可 
能 地 将 COG 放 在 这 个 轨迹 上 。 考 虑 到 这 一 点 ， 必 须 保 持 COG 在 其 工作 空间 的 
范围 内 。 因 此 ， 定 义 新 的 COG 位 置 为 路 径 函 数 pa) 与 COG 工作 区 间 的 边界 
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人 i -> 

要 找到 新 的 COG 位 置 ， 第 一 步 是 测试 腿 需 要 跟随 什么 类 型 的 轨迹 。 图 3. 9 
显示 了 如 何 区 分 两 条 轨迹 的 角度 。 


a, “arctan (3.35) 


2R; 
如 果 COG 位 于 x, Ab, FFA MMA xt COG 工作 区 前 端 ， 则 轨迹 需 满足 
Pam TR.) Pln) — 


aa arctan L 
A R 


即 腿 将 执行 A 型 轨迹 。 否 则 ， 腿 执行 B 型 轨迹 (图 3.9). 

如 果实 现 A 型 轨迹 ， 则 新 的 COG 位 置 是 len HR ,p(x 十 R,)]。 机 体 将 从 
初始 位 置 Lzw,zp(Czw)] 沿 直线 前 进 到 这 个 位 置 。 然 后 重复 此 步骤 。 

当 COG 必须 遵循 B 型 轨迹 时 ， 路 径 穿 过 COG 边界 侧面 限制 。 要 发 现 这 个 
交点 ， 可 以 使 用 连续 二 等 分 方法 。 该 方法 计算 方程 fo) =0 在 区 间 [zi,z*] 的 
一 个 根 ， 其 中 f(a.) f(a.) <0, WT UMAR, KE [rsr] 在 点 x 二 (zi 十 
x2) /2 处 是 二 等 分 的 。 如果 |zi 一 xz | 三 e， 其 中 。 是 极 小 正 数 ， 则 zx 是 根 。 否 则 如 
果 f(a) f@ <0, [noc] 中 可 能 包含 根 。 如 果 不 是 ， [x ,zz」 包含 根 并 验证 
fla’) f(zs) 二 0。 该 过 程 在 包含 x 的 区 间 内 重复 ， 直 到 满足 |x r <e. 

这 种 迭代 方法 很 简单 ， 确 保 能 够 找到 方程 的 根 ， 但 是 如 果 s 太 小 ， 和 迭代 次 数 
可 能 很 多 。 这 个 数字 也 决定 了 方程 的 准确 性 。 对 于 步行 机 器 ， 精 度 为 0. 5cm 就 
够 了 ， 即 s 王 0. 005m， 该 算法 几 次 迭代 就 可 完成 ， 没 有 大 的 计算 负担 。 

上 述 方法 计算 出 方程 fo) =0 的 根 ， 但 本 书目 的 是 计算 p (zr) 与 通过 点 
[zw (zw 十 RR,/2)] 或 [zyb(Czn 一 R,/2)] 的 水 平 线 的 交点 ， 这 取决 于 与 路 径 
相交 的 横向 极限 。 如 果 x 轴 的 坐标 系统 变换 为 横向 极限 位 置 ， 可 以 应 用 平分 法 。 
这 个 轴 转 换 相当 于 根 的 计算 功能 。 


f(x)=p(x)—p(zr,) fa 
QA 


式 中 x, 一 一 COG 的 横 坐 标 值 ; 
as4 一 一 是 轨迹 角 的 估计 值 ， 可 以 通过 式 (3.36) 计算 。 
新 的 COG 位 置 已 知 ， 执 行 机 器 人 运动 的 步骤 算法 见 3. 5 节 。 


3.7.2 转弯 步 态 的 路 径 跟 踪 


不 连续 转弯 步 态 是 在 3. 6 节 定 义 的 ， 特 点 是 点 (zx;,y;) 和 角度 ww。 点 sy) 

是 在 一 个 阶段 或 半 周 期 结束 时 新 的 位 置 COG，x 是 机 体 在 每 个 阶段 中 必须 旋转 

的 角度 ， 以 保持 机 体 纵 轴 与 所 需 路 径 相 切 。 新 的 COG 位 置 在 距离 当前 COG 位 
置 工 的 路 径 上 。 因 此 ,该 点 同时 是 定义 的 路 径 也 数 的 解 。 

=p (3. 38) 


(3. 36) 


(3.37) 
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€ AE a i aa p G a h a a a a a a ee ee a ES ne ee ee ee 
距离 当前 COG 位 置 为 工 的 点 的 方程 式 为 
(二 [一 一 (3. 39) 
用 牛顿 解决 非 线性 方程 组 的 方法 计算 解决 方案 。 该 方法 解 非 线性 方程 组 
f(x,y) =0 
(3. 40) 
g(x,y) =0 


条 件 是 解 的 初始 近似 值 (zs,yo) 可 用 。 这 个 方法 可 以 在 任何 基本 数值 方法 
教科 书 中 找到 。 通 常 ， 该 过 程 通过 几 次 迭代 可 得 准确 的 解 值 ， 提 供 足 够 接近 于 真 
正解 的 初始 近似 值 。 

st (3.38) MÈ (3.39) 应 用 牛顿 法 求解 ， 应 写成 

FI O=s— pQ)=0 : 
| 

该 解决 方案 为 COG 提供 了 新 的 位 置 ， 使 机 体 纵 轴 与 路 径 相 切 ， 机 体 的 旋转 
角度 由 新 COG 点 路 径 的 导数 p Can) 给 出 。 

该 方法 需要 初始 近似 解 。 粗 略 的 方法 是 用 目前 的 COG 位 置 。 更 好 的 方法 
是 ， 在 距离 工 处 的 路 径 的 切线 方向 上 选择 一 个 点 ， 即 [(Czw + L/2) cosars ym + 
(L/2)sinar], Hef ar=arctan[ p' (zw)]。 使 用 粗略 方法 ， 该 算法 平均 收敛 于 20 
次 迭代 ， 而 第 二 种 方法 可 以 通过 2 次 迭代 求 得 。 


3.7.3 路 径 跟 踪 示 例 


(3. 41) 


为 了 说 明 上 述 方法 ， 分 别 模拟 了 一 些 不 连续 蟹 行 步 态 和 不 连续 转弯 步 态 的 路 
径 跟 踪 。 用 于 说 明 这 两 种 情况 的 函数 为 
pa=}sin( Ze) (3. 42) 


图 3. 17 所 示 为 使 用 不 连续 稻 行 步 态 的 路 径 跟 踪 。 肥 加 在 期 望 和 真实 路 径 上 
的 矩形 表示 机 器 人 的 COG 工作 空间 。 相 对 于 定义 的 机 体 工 作 区 ， 真 正 的 COG 


有 所 需 轨 迹 -一 实际 轨迹 ---COG 工作 区 
图 3. 17 使 用 不 连续 蟹 行 步 态 的 路 径 跟 踪 
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工作 空间 前 置 一 半 。 图 3. 17 以 实 线 表示 该 机 器 人 的 第 一 个 姿态 。 当 执行 A 型 轨 
迹 时 ， 机 体 被 推进 。 因 此 ， 每 一 个 连续 的 机 体 工 作 空间 相 切 。 当 执行 B 型 轨迹 
IN, PLAT EK ae 

图 3. 18 所 示 为 使 用 不 连续 转弯 步 态 的 路 径 跟 踪 ， 在 这 种 情况 下 ， 画 出 每 个 
阶段 结束 时 的 机 体位 置 。 因 此 ， 图 3. 18 中 每 个 步 态 周期 有 两 个 机 体 图 ，。 


图 3. 18 ”使 用 不 连续 转弯 步 态 的 路 径 跟踪 


例子 中 的 路 径 使 用 得 行 步 态 和 转弯 步 态 均 可 以 实现 良好 的 跟踪 。 当 然 ， 由 其 
衍生 的 一 个 变化 很 大 的 路 径 ， 可 能 需要 蟹 行 角 或 旋转 角 ， 这 使 得 机 体 不 稳定 。 在 
这 种 情况 下 ， 机 器 人 必须 采用 不 同 的 步 态 。 对 于 移行 步 态 ， 机 器 人 需要 改变 其 腿 
部 轨迹 〈 例 如 情况 C 或 情况 D) 。 对 于 转弯 步 态 ， 机 器 人 可 能 需要 使 用 旋转 步 态 。 


3.8 结论 


本 章 对 步行 机 器 的 连续 和 不 连续 的 周期 性 步 态 进行 研究 和 比较 。 指 出 不 连续 
步 态 相 对 其 他 步 态 有 一 些 优 点 。 这 些 优 势 可 以 提高 稳定 性 ， 简 化 在 实际 机 器 控制 
的 实现 ， 比 中 等 和 大 占 地 系数 的 波浪 步 态 可 实现 高 速度 等 。 连 续 步 态 表 现 出 平滑 
的 机 体 运 动 ， 而 不 连续 的 步 态 使 机 体 摇 摆 。 

了 解 了 不 连续 步 态 的 重要 性 后 ,研究 了 和 做 行 步 态 和 转弯 步 态 的 几 种 变化 。 对 
不 连续 蟹 行 步 态 的 4 种 方法 进行 了 研究 。 它 们 的 稳定 性 和 效率 不 同 ， 应 选择 最 适 
合 方法 的 策略 。 

转弯 步 态 ， 根 据 转弯 半径 分 为 圆 形 步 态 和 旋转 步 态 ， 并 进行 分 析 。 不 连续 蟹 
行 步 态 和 圆周 步 态 ， 使 用 相同 的 腿 序 列 ， 在 步 态 周 期 的 开始 和 结束 腿 的 位 置 也 相 
同 。 这 样 就 可 以 组 合 不 同 的 步 态 跟 踪 轨 迹 。 

当 使 用 与 其 他 步 态 相同 的 腿 部 动作 序列 时 ， 旋 转 步 态 失 去 稳定 性 ,但 是 使 用 
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相同 的 立足 点 可 定义 一 个 新 的 腿 部 动作 序列 。 这 样 ， 旋 转 步 态 也 可 以 与 蟹 行 步 态 
和 圆周 步 态 一 起 使 用 跟踪 定义 的 路 径 。 本 书 考虑 了 两 种 不 同 的 腿 部 动作 序列 用 于 
旋转 步 态 ， 以 优化 腿 部 运动 的 数量 。 

3. 7 节 提 出 了 使 用 不 连续 蟹 行 步 态 和 转弯 步 态 的 一 些 方法 来 跟踪 预定 义 的 路 
径 。 本 章 提出 的 步 态 已 经 在 SILO4 步行 机 器 人 上 验证 。 
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险 第 4 章 非 周期 步 态 的 生成 


4.1 简介 - 


第 3 章 介 绍 的 周期 步 态 具 有 重要 优点 ， 很 快 就 推广 使 用 了 。 但 是 ,它们 也 有 
显著 的 缺点 ， 其 固定 的 形式 妨碍 了 适应 性 。 

如 第 1 章 所 述 ， 步 态 算法 的 一 个 问题 是 在 给 定 路 径 上 的 导航 。 周 期 步 态 可 以 
遵循 直线 或 圆 形 轨迹 ， 但 通过 连接 分 段 轨迹 用 来 跟踪 复杂 路 径 较为 麻烦 。 这 是 因 
为 周期 步 态 需 要 某 些 初始 足 端 位 置 〈 在 机 体 参 考 坐 标 系 中 ) 来 执行 运动 ， 而 这 些 
位 置 取决 于 轨迹 。 虽 然 已 经 提出 了 几 种 解决 方案 来 组 合 不 同 的 周期 步 态 〈 第 3 
章 ) ， 一 个 具有 完全 适应 性 的 步 态 应 该 能 够 找到 足够 的 立足 点 和 合适 的 腿 部 摆动 
顺序 ， 可 从 任何 初始 条 件 开始 跟随 任何 轨迹 。 

周期 步 态 的 另 一 个 限制 是 它们 对 包含 禁区 的 地 形 无 效 ， 比 如 步行 机 器 不 适合 
支撑 的 区 域 。 禁 止 区 域 是 一 致 的 ， 例 如 不 规则 地 形 上 的 壕沟 或 垂直 边缘 。 通 过 非 
常 崎 赋 的 地 形 时 ， 一 个 具有 完全 适应 性 的 步 态 应 该 是 能 够 改变 它 的 支撑 点 ， 甚 至 
腿 部 动作 序列 ， 人 

自 步行 机 器 人 後 始 以 来 ， 这 些 问 题 激 发 了 自由 步 态 的 研究 (Kugushev 和 
Jaroshevskij，1975) 。 采 用 自由 步 态 时 ， 腿 的 序列 立足 点 和 机 体 动作 以 不 固定 、 
灵活 的 方式 进行 规划 ， 是 轨迹 、 地 面 特征 和 机 器 状态 的 函数 。 因 此 ， 当 在 具有 禁 
区 的 地 形 中 需要 保证 机 动 性 时 ， 自 由 步 态 比 周 期 步 态 和 自 适 应 步 态 更 有 效 。 

迄今 ， 已 经 有 大 量 的 四 足 机 器 人 和 六 足 机 器 人 的 自由 步 态 。 为 满足 运动 和 稳 
定性 限制 ， 由 于 具有 更 多 可 能 的 选择 〈 立 足 点 、 机 体 动 作 等 )， 自 由 步 态 已 经 证 
明 可 以 有 效 控 制 六 足 机 器 人 (Wettergreen 和 Thorpe, 1992; Salmi 和 Halme, 
1996) 。 对 于 四 足 机 器 人 ， 自 由 步 态 算法 更 容易 进入 锁 死 状态 ， 即 出 现 不 能 共同 
满足 这 些 基本 限制 的 情况 。 相 对 于 六 足 机 器 人 ， 四 足 机 器 人 可 行 的 自由 步 态 数量 
小 得 多 。 试 验 结果 表明 ， 在 含有 禁区 的 崎 赋 地 形 下 ， 实 现 四 足 机 器 人 的 有 效 运动 
仍然 需要 更 多 努力 。 

产生 自由 步 态 有 两 种 方法 ， 即 基于 规则 的 自由 步 态 和 基于 搜索 的 自由 步 态 。 
两 种 方法 都 经 过 大 量 的 仿真 测试 ， 对 四 足 机 器 人 和 六 足 机 器 人 自由 步 态 得 出 了 许 
多 结论 。 
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基于 规则 的 方法 是 ， 由 程序 员 设 计 规 则 来 规划 机 器 人 的 动作 (Hirose, 
1984; Shih 和 Klein, 1993; Chen 等 ，1999b; Bai 等 ，1999)， 通常 基于 自学 习 
(Maes 和 Brooks, 1990) 或 者 源 于 自然 界 的 生物 机 制 (Dean 等 ，1999)。 这 些 
规则 包含 了 关于 机 器 人 如 何 移动 以 实现 有 效 运动 的 特定 知识 。 例 如 ，Hirose 
(1984) 提出 了 慎 思 法 ， 采 用 几何 方法 来 限制 和 选择 立足 点 ， 可 以 保持 标准 步 态 
序列 〈3. 2 节 )。 当 标准 步 态 序列 不 可 行 时 ，Bai (1999) 等 通过 后 续 工 作 综合 了 
这 一 序列 并 产生 蔡 代 的 腿 部 动作 序列 。 基 于 规则 的 算法 用 于 四 足 机 器 人 存在 缺 
点 ， 如 其 表述 复杂 ， 这 意味 着 必须 强制 使 用 过 度 简 化 的 模型 。 例 如 ， 使 用 纵向 稳 
ERE (第 2 章 ) (Hirose, 1984; Bai 等 ，1999; Chen 等 ，1999b) 简化 规划 。 
但 是 这 对 于 具有 任意 腿 部 轨迹 和 和 蟹 行 角 的 真实 机 器 人 来 说 ， 在 不 规则 地 形 上 行走 
是 不 实用 的 。 

在 基于 搜索 的 方法 中 ， 在 模拟 中 不 同 序列 的 机 器 人 动作 盲目 生成 和 测试 ， 以 
确定 它们 是 否 会 产生 可 行 的 机 体 运 动 (Pal 和 Jayarajan, 1991; Wettergreen 和 
Thorpe, 1992 年 ; Chen 等 ，1999a; Eldershaw 和 Yim, 2001; Pack 和 Kang, 
1999)。 由 于 大 量 的 机 器 人 动作 序列 是 可 行 的 ， 搜 索 方法 必须 找到 有 效 的 运动 规 
划 。 虽 然 以 搜索 为 基础 的 一 些 自由 步 态 提供 了 一 个 独立 于 腿 数量 的 简单 策略 ， 但 
可 能 会 阻碍 其 应 用 于 四 足 机 器 人 。 例 如 ， 对 机 器 人 动作 选择 的 数量 必须 严格 限 
制 ， 避 免 运动 序列 无 法 控制 。 一 些 作 者 (Pack 和 Kang, 1999; Pal 和 Jayara- 
jan, 1991) 考虑 了 3 个 或 4 个 候选 立足 点 用 于 每 个 足 端 放置 。 对 于 四 足 机 器 人 ， 
这 是 一 个 严重 的 限制 ， 应 该 仔细 计划 立足 点 实现 足够 的 腿 部 序列 ， 同 时 保持 

许多 精心 策划 的 自由 步 态 ， 其 典型 的 缺点 是 难以 结合 异常 细致 的 规划 动作 和 
反应 行为 ， 以 满足 在 实际 环境 中 的 应 用 。 已 经 在 六 足 机 器 人 (Brooks, 1989; 
Dean 等 ，1999) 和 八 足 机 器 人 (Bares 和 Wettergreen, 1999) 中 成 功 测 试 了 自 
由 步 态 ， 其 中 稳定 性 限制 可 以 以 一 种 非常 简单 的 方式 实现 〈 即 考虑 腿 的 状态 ， 摆 
动 或 支撑 ， 但 忽视 其 位 置 )。 其 立足 点 规划 不 像 四 足 机 器 人 对 稳定 性 和 序列 条 件 
有 严格 限制 。 基 于 节律 模式 发 生 器 的 反应 步 态 (Fukuoka 等 ，2003; Lewis 和 
Bekey, 2002) 在 控制 四 足 机 器 人 结果 方面 产生 了 令 人 深刻 的 印象 。 然 而 ， 没 有 
纯粹 的 基于 反应 步 态 的 方法 是 成 功 的 ， 例 如 无 法 在 存在 禁止 单元 的 崎 嵌 地 形 上 精 
确 地 立足 。 

本 章 介绍 新 的 自由 步 态 ， 可 以 用 于 真正 的 四 足 机 器 人 全 方位 移动 ， 并 通过 不 
规则 地 形 (Estremera 和 Gonzalez de Santos，2002)。 这 些 步 态 可 以 规划 机 器 人 
不 同 部 分 的 动作 ， 实 现 机 体 遵循 直线 或 圆 形 轨迹 的 静态 稳定 运动 。 建 议 采 用 基于 
规则 的 算法 以 产生 灵活 的 腿 部 序列 并 选择 足够 的 立足 点 ， 以 提高 机 动 性 和 地 形 适 
应 性 。 自 由 步 态 可 以 通过 更 先进 的 软件 模块 组 合 执行 有 效 的 路 径 跟踪 。 另 外 ， 一 
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个 人 操作 者 可 以 组 合 3 种 步 态 ， 在 实际 情况 中 引导 机 器 人 ， 如 第 9 章 所 述 。 但 
是 ， 路 径 规划 超出 了 本 章 的 范围 。 这 些 步 态 是 在 真实 的 机 器 人 上 进行 测试 ， 并 且 
验证 了 其 步 态 性 能 的 改善 。 本 章 的 内 容 如 下 : 4.2 一 4.4 节 提出 了 一 个 自由 蟹 行 
步 态 和 自由 旋转 步 态 。4. 5 节 介 绍 用 SILO4 步行 机 器 人 进行 一 些 实验 。4. 6 WIA 
纳 了 一 些 结论 。 自 由 步 态 的 方案 和 结论 针对 一 般 的 四 足 机 器 人 ， 但 示例 和 实施 细 
节 专 门 针 对 SILO4 步行 机 器 人 。 


4.2 自由 蟹 行 步 态 


如 上 所 述 ， 这 种 新 的 自由 步 态 是 使 真实 机 器 人 能 够 通过 不 平坦 地 形 的 高 效 步 
态 。 静 态 稳定 控制 被 认为 可 简单 控制 的 步行 机 器 ， 其 配备 慢 速 致 动 器 和 最 少 的 传 
感 器 集合 。 此 外 ， 步 行 机 器 人 的 许多 潜在 应 用 〈1. 5 节 )， 如 需要 重型 和 慢 速 移 
动 的 机 器 ， 可 以 考虑 静态 稳定 控制 。 原 则 上 选择 非 周期 自由 步 态 是 因为 可 随时 改 
变 轨 迹 ， 具 备 在 带 禁止 区 域 的 崎 嵌 地 形 上 行进 的 能 力 。 不 连续 步 态 〈3.4 节 ) 也 
是 较 好 的 候选 方案 ， 因 为 它们 具有 地 形 适 应 的 内 在 特征 ， 且 容易 实现 。 不 连续 步 
态 下 ， 机 体 的 一 条 腿 处 于 摆动 阶段 而 机 体 仍 然 静 止 。 这 简化 了 步 态 的 规划 ， 因 为 
避免 了 腿 部 协调 问题 。 立 足 点 的 选择 只 是 确定 立足 点 的 工分 量 和 >y 分 量 的 问题 ， 
因此 在 此 选择 中 没有 时 间 限 制 。 这 意味 着 从 旧 的 支撑 点 到 新 的 立足 点 ， 摆 动 时 间 
是 无 关 紧 要 的 。 例 如 ， 超 过 预期 时 间 的 摆动 ， 机 器 人 的 稳定 性 不 会 受到 损害 。 同 
样 ， 在 腿 部 摆动 过 程 中 ， 永 远 不 会 离开 它们 的 工作 空间 ， 不管 它 持续 多 长 时 间 。 
通过 步 态 规划 算法 ， 新 立足 点 = 的 分 量 也 可 以 忽略 ， 可 以 在 执行 摆动 过 程 中 通过 
使 用 简单 的 接触 传感器 确定 。 

这 里 提出 的 自由 步 态 来 自 于 Hirose (1984) 所 提出 的 算法 ,特别 是 用 于 立 
足 点 搜索 的 方法 。 腿 部 序列 规划 遵循 Bai (1999) 等 提出 的 方法 ， 采 用 标准 腿 部 
序列 为 默认 选择 。 当 需要 使 用 较 低 运动 裕 度 提升 腿 时 ， 可 以 采用 灵活 的 腿 部 
序列 。 i 

步 态 由 序列 规划 器 〈 负 责 施 加 某 些 腿 部 顺序 标准 来 协调 足迹 搜索 和 腿 部 抬 
升 )、 立 足 点 规划 器 、 机 体 运 动 规划 器 和 腿 抬升 规划 器 模块 完成 。 附 加 稳定 性 约 
柬 算 法 的 一 般 原 理 如 图 5. 10 所 示 。 在 描述 步 态 模块 之 前 ， 定 义 一 些 基 本 概念 。 


4.2.1 步行 机 器 的 模型 和 基本 概念 
步 态 生成 采用 四 足 步 行 机 器 的 简化 二 维 模型 。 假 定 重心 位 于 机 体 的 几何 中 
心 ， 即 机 体 参考 坐标 系 的 原点 ; 假设 无 质量 的 腿 。 机 体 假 定 为 水 平 运 动 。 通 过 在 


控制 回路 中 使 用 倾角 仪 、 反 应 姿态 控制 器 来 保证 机 体 旋 转 至 水 平 。 足 端 工作 区 由 
两 个 水 平面 和 任意 形状 垂直 表面 界定 ， 相 邻 腿 的 工作 空间 可 以 重 又 。 例如， 在 
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HERE Ssy=di=min (di, dz, d3) 


腿 工 作 空间 水 平 投影 
图 4.1 静态 稳定 步行 机 器 人 示意 图 


机 器 稳定 性 采用 静态 稳定 裕 度 Ssw 测 量 (2. 2 节 ) 。 该 算法 保持 静态 稳定 裕 度 
大 于 给 定 的 最 小 值 Susw， 作 为 在 实际 工 况 下 提高 性 能 的 方式 并 应 对 模型 缺陷 。 
如 果 满 足 该 条 件 ， 则 机 器 是 稳定 的 。 正 如 上 文 所 述 (Hirose，1984; Bai 等 ， 
1999; Chen 等 ，1999b; Pack 和 Kang，1999) ， 采 用 纵向 稳定 性 裕 度 Lism (2.2 
节 ) 以 简化 算法 。 因 此 ， 静 态 稳定 裕 度 的 使 用 可 以 认为 是 此 算法 的 第 一 个 改进 。 
McGhee 和 Iswandhi (1979) 介绍 了 腿 的 运动 学 裕 度 KM， 其 定义 为 给 定 腿 在 运 
动 方向 相反 的 方向 上 ， 立 足 点 与 其 工作 区 边界 之 前 的 距离 。 图 4. 1 说 明了 这 些 基 
本 概念 和 定义 。 

1. 推导 自由 步 态 的 术语 

(1) LT: 腿 在 摆动 相 。 

(2) NLT: 下 一 条 腿 去 摆动 相 。 

G) KM : 支撑 腿 的 最 小 运动 裕 度 。 

(4) LKMin: 具有 最 小 运动 裕 度 的 腿 。 

(5) LKM;: 腿 部 具有 第 i 小 的 运动 裕 度 。 

(6) SM: 运动 期 间 要 求 的 最 小 稳定 裕 度 。 

2. 蟹 行 步 态 的 四 种 类 型 

每 种 类 型 允许 机 体 参 考 坐 标 系 xz 轴 与 轨迹 形成 一 定 角度 ， 这 个 角度 a 称 为 
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部 分 “步行 测量 和 算法 
蟹 行 角 ， 不 同类 型 的 步 态 定义 为 : 

(1) SO K+H: 当 315’<2. 45 时 ， 

(2) 类 型 六 一 当 135 <a 225 hhe 

(3) 类 型 Y 十 : 当 45"<a. 过 135° 时 。 

(4) BR Y=, 44 225°<e.< 315 HN. 

3. 各 腿 的 区 分 

这 些 域 是 通过 考虑 四 足 机 器 的 对 称 性 来 选择 的 。 当 步 态 选 择 为 扔 行 角 的 函数 
之 后 ， 区 分 各 腿 的 术语 为 : 

(1) FRL: 右前 腿 。 

(2) FLL: 左前 腿 。 

(3) RRL: 右 后 腿 。 

(4) RLL: 左 后 腿 。 

根据 这 个 定义 ， 两 条 腿 可 以 分 为 并 行 (两 个 右 腿 或 两 个 左 腿 ) 或 对 侧 ; 而 
A, 与 蟹 行 角 无 关 ， 两 条 腿 可 分 为 相 邻 或 不 相 邻 。 


4.2.2 地 形 模型 和 地 形 适 应 


Hiros (1984) 描述 的 H 型 地 形 用 于 创建 模拟 环境 。H 型 地 形 定义 为 可 以 实 
现 无 障碍 规则 行走 的 地 面 ， 但 包含 洼地 〈 孔 或 沟 )。 为 了 使 用 二 维 步 态 规划 ， 应 
考虑 如 下 可 选 立足 点 的 可 能 性 : 

d) 立足 点 高 度 。 立 足 点 高 度 是 指 机 器 人 参考 坐标 系 中 介 于 工作 空间 的 上 限 
和 下 限 之 间 的 ， 这 个 立足 点 是 可 行 的 。 在 这 种 情况 下 ， 立 足 点 就 是 一 个 允许 的 地 
形 点 ， 直 接 通 过 不 连续 步 态 解决 了 地 面 适应 性 问题 。 

(2) 立足 点 低 于 可 适应 空间 的 下 限 ， 即 立足 点 被 放 在 一 个 洞 里 。 在 这 种 情况 
下 ， 这 个 立足 点 被 认为 是 禁止 的 地 形 点 。 

(3) 立足 点 高 于 可 适应 空间 的 上 限 ， 即 立足 点 被 放置 在 地 形 的 隆起 处 。 在 这 
种 情况 下 ， 地 形 被 视 为 障碍 ， 因 为 机 器 人 没有 任何 部 分 可 通过 它 。 

对 于 可 能 的 立足 点 分 类 ， 前 两 种 可 能 是 在 实用 的 地 形 上 正常 运行 ， 步 态 生成 
器 需要 的 唯一 关于 环境 的 信息 。 第 三 种 可 能 性 代表 不 切实 际 的 地 形 ， 需 要 更 高 的 
自主 能 力 改变 机 器 人 的 轨迹 ， 避 免 这 样 的 地 区 。 

地 形 分 为 方形 单元 ， 标 记 为 禁止 或 允许 的 立足 点 。 此 时 ， 机 器 人 需要 知道 关 
于 禁止 单元 完整 的 地 图 。 然 而 ， 在 每 次 腿 摆 动 时 ， 只 有 包围 在 腿 部 工作 空间 中 的 
立足 点 被 探索 ， 因 此 只 能 提前 规划 一 条 腿 的 立足 点 。 这 实际 上 相当 于 通过 使 用 传 
感 器 探索 一 个 特定 的 腿 〈 位 于 一 个 靠近 地 形 区 域 ) 可 能 的 立足 点 。 这 样 的 执行 感 
官 系统 对 实现 任务 是 非常 重要 的 。 

当选 择 新 的 立足 点 时 ， 摆 动 足 垂直 抬 起 ， 放 置 在 立足 点 之 上 ， 即 在 其 r% 
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ERAI y 坐标 上 ， 并 沿 垂 直 轨 迹 降 低 。 当 接触 传感器 指示 足 端 已 触及 地 形 表 面 时 
该 轨迹 停止 。 知 道 支 撑 点 的 相对 高 度 飞 如 果 可 能 ， 或 使 用 外 部 获得 的 地 形 信息 ) 
并 采用 独立 的 高 度 控制 器 调节 机 体 垂直 运动 ， 使 其 保持 在 地 形 上 有 利 的 高 度 。 


4.2.3 腿 部 序列 规划 


腿 部 序列 规划 器 确定 应 该 抬 起 的 下 一 条 腿 和 立足 点 应 该 满足 的 和 条件， 以 方便 
执行 腿 部 序列 。 这 些 条 件 将 决定 摆动 腿 立 足 点 搜索 区 域 的 形状 。 考 虑 两 个 基本 标 
准 并 合并 在 一 起 ， 形 成 最 终 算 法 。 

1. FEN: 自然 序列 

在 第 一 个 标准 中 ， 腿 部 序列 是 基于 波浪 步 态 使 用 的 标准 步 态 规划 的 序列 
(3.2 节 )。Hirose (1984) 对 自由 步 态 采 用 了 这 一 序列 ， 也 用 于 两 相 不 连续 步 态 
(3.4.1 节 )。 选 择 这 个 腿 部 序列 的 主要 原因 是 可 以 实现 最 佳 的 速度 和 稳定 性 。 这 
个 腿 部 序列 和 与 之 匹配 的 机 体 运 动 称 为 自然 序列 ， 即 以 下 列 方式 定义 的 周期 序 
Ji; RRL 摆动 FRL 摆动 ~ 机 体 运 动 ~>RLL FLL 摆动 ~ 机 体 运动 。 

给 定 一 条 腿 处 于 摆动 相 LT， 规 划 的 新 立足 点 满足 这 个 顺序 要 求 的 条 件 。 这 
些 序列 条 件 如 下 [图 4.2 Ch) ]: 

(1) 条 件 N1: 如 果 LT 是 后 腿 ， 则 其 新 的 立足 点 必须 允许 在 其 放置 后 ， 同 
侧 其 他 腿 能 立即 稳定 提升 。 

(2) 条 件 N2: 如 果 LT 是 后 腿 ， 其 立足 点 必须 在 机 体 运 动 长 度 KM 之 后 ， 
能 够 稳定 地 提升 对 侧 后 腿 。 计 算 KMi,， 不 考虑 对 侧 后 腿 的 KM， 因 这 条 腿 在 
LT 放置 后 立即 提升 (Hirose，1984) 。 

(3) 条 件 N3: WR LT 是 前 腿 ， 甚 立足 点 必须 有 利于 为 对 侧 后 腿 满足 搜索 
条 件 NI 和 N2。 在 应 用 条 件 N3 之 前 ， 必 须 进 行 检查 以 确定 机 体 运 动 需要 抬 起 对 便 
后 腿 到 处 于 静态 稳定 的 LT 是 否 小 于 KMn 。 如 果 没 有 ， 搜 索 失 败 ， 因 为 对 方 后 腿 
不 能 稳定 地 抬 起 ， 而 与 LT 的 立足 点 无 关 。 这 个 条 件 将 在 4. 2.4 节 进 一 步 描述 。 

(4) 条 件 N4: 新 立足 点 的 KM 必须 大 于 KM ino HOARE BPR LT 的 放置 不 
会 导致 全 局 KM 减少 。 

如 果 找 到 满足 这 些 条 件 的 立足 点 ， 那 么 自然 序列 的 下 一 条 腿 将 被 标记 为 新 
的 LT。 

2. PEK: BABE 

在 第 二 个 标准 中 ，(McGhee 和 Iswandhi, 1979) 基于 腿 部 运动 裕 度 选择 腿 
部 序列 ， 并 试图 在 项 态 稳定 下 抬 起 具有 较 低 KM 的 腿 ， 以 增加 支撑 腿 的 KM min o 

假设 机 器 有 一 条 腿 在 摆动 阶段 LT. 为 最 大 化 支撑 腿 的 最 小 运动 边界 ， 具 有 
最 低 运动 裕 度 的 腿 首先 应 该 能 够 抬 起 。 所 以 ,将 分 配 NLT=LKMain, FF ARTES 
前 LT 和 NLT 的 任务 分 配 ， 对 LT 的 立足 点 施加 如 下 条 件 : 
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(1) 条 件 K1: 如 果 LT 和 NLT 是 同 侧 腿 且 LT 是 后 腿 ， 则 立足 点 必须 允许 
在 LT 放置 后 ，NLT 可 立即 稳定 抬 起 [图 4.2 (a)]。 把 同 侧 腿 放 在 一 个 相似 的 
相位 ， 根 据 标准 N 已 经 被 证 明 是 有 用 的 〈4. 2. 3 节 ) 。 

(2) 条 件 K2: 如 果 LT 和 NLT 是 同 侧 腿 ，LT 是 前 腿 ， 那 么 LT 的 立足 点 
必须 能 够 在 机 体 运动 后 长 度 KM ， 稳 定 地 提升 NLT [图 4.2 (b)]。 结 合 条 件 
K1， 这 个 条 件 有 助 于 带 来 对 侧 腿 之 间 的 相位 差异 。 

(3) 条 件 K3: 如 果 LT 和 NLT 是 后 腿 ， 则 LT 的 立足 点 必须 允许 机 体 运 动 
长 度 KMi, 后 ，NLT 稳定 抬 起 [图 4.2 (c)]。 这 种 情况 将 有 利于 后 腿 摆动 时 的 
机 体 运动 ， 有 利于 产生 对 侧 腿 相位 之 间 的 差异 。 

(4) 条 件 K4: WR LT 和 NLT 是 前 腿 ， 则 立足 点 必须 允许 LT 放置 后 ， 
NLT 立 即 稳定 抬 起 [图 4.2 (d)]. 

(5) 条 件 K5: 如 果 LT 和 NLT 是 前 腿 ， 则 LT 的 立足 点 必须 允许 在 机 体 运 
动 长 度 LTKMan 后 ,将 LT 的 同 侧 腿 稳 定 抬 起 [图 4.2 (e)]。 这 是 一 个 可 选 约 
束 ， 有 助 于 避免 锁 死 ， 如 果 与 K4 矛盾 则 被 忽略 。 

(6) 条 件 K6: 如 果 LT 和 NLT RHR, LT 是 后 腿 ， 则 搜索 失败 ， 一 条 新 腿 
被 定义 为 NLT [图 4.2 (f)]。 这 是 因为 不 管 LT 如 何 选择 立足 点 NLT 均 不 能 稳定 
抬 起 。 

(7) 条 件 K7: WMR LT Al NLT AAS, LT 是 前 腿 ， 机 体 运 动 需要 提升 
NLT (其 仅 取决 于 剩 下 两 条 腿 的 位 置 ) 比 KM, 短 ， 序 列 规划 器 不 会 施加 任何 
条 件 ， 则 采用 K8 搜索 立足 点 [图 4.2 (g)]。 

(8) 条 件 K8: 无 论 如 何 ， 立足 点 的 KM 必须 大 于 LT 的 KM。 当 NLT 开始 
摆动 相 时 ， 此 条 件 保证 了 KM, 的 增加 。 

为 避免 锁 死 ， 设 计 一 组 条 件 KI~ KS, 在 模拟 中 已 经 证 明 有 助 于 过 渡 到 
4. 2. 3 节 描 述 的 自然 序列 。 

如 果 在 这 些 条 件 下 寻找 立足 点 失败 ， 那么 第 二 个 最 小 KM 的 腿 就 被 标记 为 
NLT， 即 它 被 分 配 NLT=LKM, 重复 搜索 立足 点 。 如 果 立 足 点 搜索 仍然 失败 ， 
那么 考虑 到 NLT 二 LKM;， 重 复 该 过 程 。 当 发 现 有 效 立 足 点 ， 则 执行 LT 的 摆 
动 ， 并 且 NLT 被 抬 起 ， 规 划 器 标记 为 新 的 LT， 此 策略 减少 了 腿 锁 死 的 可 能 性 。 
LT 的 立足 点 可 能 处 于 各 种 不 同 的 搜索 区 域 ， 见 4.2.4 节 。 

3. 完整 算法 

步 态 算法 将 使 用 标准 N 作为 腿 部 序列 的 起 点 并 搜索 立足 点 。 为 了 获得 高 速 ， 
采用 自然 序列 。 这 个 标准 通常 适用 于 以 下 情况: 

(1) 初始 足 端 位 置 接近 于 两 相 不 连续 步 态 的 足 端 位 置 。 

(2) 运动 方向 接近 机 体 参 考 坐 标 系 的 纵 轴 或 横 轴 。 

(3) 有 少量 禁区 或 没有 禁区 。 
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(a) 条 件 Kl 


Y | Cb) 条 件 K2 
NLT 
p | bet bah 条 件 K3 


(d) 条 件 K4 


LT 
(f) 条 件 K6 


ye A (g) 条 件 K7 
区 站 yi ch) RFF K8 


图 4.2 序列 条 件 
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如 果 该 标准 失败 ， 如 下 一 条 腿 不 能 被 抬 起 或 条 件 NI 一 N4 不 能 满足 任何 立足 
点 ， 则 使 用 标准 K 和 条 件 K1 一 K8 寻找 新 的 立足 点 。 第 二 个 标准 是 在 更 多 情况 
下 有 效 的 ， 并 能 够 搜索 更 多 的 可 行 选择 ， 减 少 锁 死 的 可 能 性 。 如 果 没 有 发 现 正 确 
的 立足 点 ， 则 步 态 是 锁 死 的 ， 算 法 失败 。 尽 管 这 种 方法 结合 使 用 了 两 种 排序 标 
准 ， 但 没有 分 离 的 步 态 ， 也 没有 像 (Bai 等 ，1999) 中 描述 的 那些 状态 ， 包 括 完 
整 的 预定 义 腿 部 抬 起 和 放置 的 序列 。 两 个 标准 N AK 只 表示 关于 序列 规划 的 两 
个 不 同 观点 。 两 个 标准 用 来 找到 每 一 个 立足 点 ， 或 者 标记 每 一 个 新 的 摆动 腿 ， 它 
们 只 表示 探索 不 同 可 能 性 的 顺序 。 


4.2.4 立足 点 规划 


立足 点 选择 必须 满足 由 顺序 规划 器 定义 的 基本 条 件 ， 确 切 的 立足 点 由 立足 点 
规划 器 计算 。 为 了 做 到 这 一 点 ， 立 足 点 规划 器 界定 了 一 个 有 效 的 区 域 来 放置 足 ， 
称 为 有 效 搜索 区 CESZ) 。 下 面部 分 将 描述 立足 点 规划 器 如 何 根据 所 施加 的 条 件 ， 
通过 序列 规划 器 定义 ESZ， 并 使 用 最 终 算法 完成 立足 点 搜索 。 

1. 立足 点 搜索 和 序列 条 件 

本 部 分 描述 为 了 满足 序列 条 件 而 限制 摆动 腿 的 ESZ 方式 。 受 到 由 Hirose 
(1984) 引入 的 对 角 线 原理 的 启发 ，3 个 立足 点 区 域 用 于 约束 可 能 的 立足 点 。 根 
据 立足 点 满足 的 序列 条 件 ， 采 用 以 下 一 个 或 多 个 区 域 : 

d) KA: 该 区 域 定义 为 LT 放置 平面 的 一 部 分 ， 允 许 立 即 抬 起 相 邻 腿 
NLT。 这 种 限制 将 有 利于 连续 的 腿 部 摆动 ， 它 们 之 间 没 有 机 体 动作 。 满 足 该 条 
件 的 区 域 是 通过 两 条 直线 Al 和 A2 确定 的 (图 4. 3) 。 


半径 为 SS 的 圆 


图 4.3 2 Al, R A2 和 区 域 A 的 定义 〈( 顶 视图 ) 
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< 


这 些 线 中 的 每 一 条 线 通过 给 定点 or) HEBA Caoc) ASH. Ask, 
从 函数 Ls 可 以 获得 这 些 线 的 方程 为 
(762): Ge 5) 
(r, —c,)? — SM 
sS Sal T aap SM dr AD 
Hp r EIEE, S% s 可 以 是 十 1 或 一 1， 表 示 实 现 上 述 定义 的 两 种 不 
同方 案 。 为 了 确定 线 Al 和 线 A2 的 参数 ， 定 义 腿 的 顺 时 针 关 系 和 道 时 针 关 系 。 
定义 4.1 如 果 它 符合 以 下 可 能 之 一 : FLL>FRL, FRL>RRL, RRL> 
RLL，RLL>FLL， 则 两 个 相 邻 腿 之 间 的 关系 LSL AMAT. RS, Æ 
以 下 情况 下 ， 两 条 腿 之 间 关 系 为 着 时 针 方向 ， FLL>RLL, RLL>RRL, RRL> 
FRL, FRL=>FLL. 
有 了 这 些 前 提 ， 限 制 区 域 A 的 直线 可 以 定义 如 下 : 
BAL: 该 线 通过 LT 不 相 邻 腿 的 支撑 点 (P,,P,), 并 且 距 离 COG 投影 
S 弱 。 该 线 的 方程 式 为 


VFL Te t= 


= 


y=LalP,,P,,0,055,x) 
=| 1, LTS>NLT 是 道 时 针 的 (4,2) 
一 1， LT>NLT 是 顺 时 针 的 
线 A2: 该 线 穿 过 NLT 不 相 邻 的 腿 的 支撑 点 (Q; ,Q,)， 并 且 距 离 COG 投影 
y=La(Q,,Q,,0,0,s,z) 
_ 111， LT>NLT 是 顺 时 针 的 
zee LT 二 NLT Æ REHA 
线 Al MA A2 将 平面 分 为 两 个 半 平 面 ， 区域 A 是 不 包含 COG 的 平面 的 交 
集 。 线 Al 和 线 A2 分 别 为 l 


(4.3) 


| Bie (4.4) 
yz =m: xr +b: 
区 域 A 可 以 从 满足 5; 条 件 的 以 下 两 个 表达 式 获得 

ym rth, bı <0 

yomath::, b >0 ta. 63 


ymzzb'*, ba <0 

y>m:x+b:**, b2 之 0 
(2) KRB: 该 区 域 定 义 为 LT 放置 平面 的 一 部 分 ， 满 足 在 由 限定 蟹 行 角 的 
方向 上 ， 机 体 运 动 长 度 M 后 ， 相 邻 的 腿 NLT 可 抬 起 。 因 此 ， 这 个 区 域 的 摆动 腿 
放置 将 有 利于 腿 摆 动 相 之 间 的 机 体位 移 。 这 个 区 域 受 到 两 条 线 Bl 和 B2 的 限制 ， 
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类 似 于 线 Al 和 线 A2， 但 通过 机 体 运 动 长 度 为 M 后 距离 COG 点 的 距离 Sh CAI 
4.4) 的 点 。 这 一 点 称 为 COGa ， 由 下 式 给 出 

COG, =Mcosa 

COGy,, = Msina 


(4. 6) 


半径 为 SEO A Al 


线 B2 


线 Bl 
图 4.4 线 BI、 线 B2 和 区 域 B 的 定义 ( 顶 视图 ) 


对 于 这 些 前 提 ， 线 B1 和 线 B2 分 别 为 

线 B1: 
y= BB COĞ COGC ,32 
=| 1， LT=NLT Beater ny 


7 
—1, LT=>NLT 是 顺 时 针 的 ji 


线 B2: 
y= aQ vO, COG COG. ia) 
_ 11， LT=>NLT 是 顺 时 针 的 
a7) LT=>NLT 是 逆 时 针 的 
其 中 P.P, 和 (Q,,Q,) 分 别 是 不 相 邻 腿 的 立足 点 LT 和 NLT。 如 式 
(4.4) 给 定 ， 线 B1、 线 B2 和 区 域 B， 由 满足 条 件 b: 的 两 个 表达 式 确定 为 
y<m xb)", bı <COGs, — m COG 
y>m rth» b>COGs,—m COGs 
ymzt 6, bı <COGs, — m, COG, 
ymt bss by >COGs, — m:COGe 


(4. 8) 


(4.9) 
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(3) 区 域 C: 该 区 域 被 定义 为 在 机 体 运 动 之 后 前 足 放 置 区 域 的 起 始点 ， 对 于 
不 相 邻 腿 的 ESZ 获得 N1 和 N2 条 件 -(4.2.3 节 )。 因 此 ， 这 个 区 域 约束 LT 的 
ESZ 立足 点 的 获得 ， 有 利于 后 续 其 他 腿 的 立足 点 搜索 。 为 了 找到 区 域 C， 若 前 腿 
处 于 摆动 相 (图 4.5), 假设 一 个 立足 点 Pt 二 (Pr ,Pr,) 并 计算 以 下 参数 : 


KM (Pe) KM (Pa) 


线 Al 线 B1 


图 4.5 定义 区 域 C 的 点 PA 的 计算 


1) F: 允许 后 腿 V 静态 稳定 抬 起 的 机 身 最 小 位 移 。 这 个 距离 是 腿 U 和 腿 W 
的 立足 点 的 函数 (Pu 和 Pw)， 由 下 式 给 出 


= Z = z 
F=,|(Decosa—Pu—Pum | + (Desina—tana Sw ue ) (4. 10) 


tana—m tana—m 
其 中 
2 
De= [Cantato (Sit L5 (4. 11) 
tana 一 770 
Po Pw, 
二 (4. 12) 


2) MR: 腿 工 (放置 在 Pr 中 ) 和 腿 U 的 最 小 运动 裕 度 。 
3) Jr: 当 腿 V 可 以 抬 起 时 ， 前 腿 工 被 放置 的 点 ， 即 
Jt: = Pr, —Fcosa 
: J+, = Pr, — Fsina 
现在 ， 假 设 腿 工 放 置 于 Jr， 可 以 计算 线 Al1: LTI=VANLT=W; ABI: 
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(4. 13) 


-部 分 “步行 测量 和 算法 

LT=V, NLT=U 和 M=MR—-F, KSC 的 极限 由 点 Pr 形成 ， 计 算 线 Al 和 
线 Bl 的 重 肆 。 两 条 线 都 通过 点 J+， 因 此 为 满足 这 一 点 条 件 ， 它 们 的 斜率 必须 相 
等 。 这 些 点 是 以 下 等 式 的 解 

(=F. y= F +53 (aF, Hy EF)? = SM 


Cr Fe) = Shn 
__ (2—MR, )(y—MR,)_, SW Va MR: + y— MR, )? SMe 
(z—MR,)*—SM2;,, ~ (x = MR — SME... 
(4.14) 
其 中 
MR, =MRcosa 
(4. 15) 
MR, =MRsina 


矩形 工作 空间 这 个 方程 的 解 在 图 4.6 给 出 ， 其 中 ac =0, KM(P,) =0. 3m, 
S% =0. 08m, F=0. lm。 当 MR 等 于 腿 U 的 KM 时 ， 由 式 〈4.14) 可 以 得 到 曲 
线 Sl; 当 MR 等 于 立足 点 Pr 的 KM 时 可 以 得 到 曲线 S2。 区 域 C 受 这 两 个 解 的 
限制 ， 如 图 4.6 所 示 。 


区 域 C 


0:2 
SB" =0. 08m 


ss | 
0.2 0.4 0.6 


zr/m 
图 4.6 用 于 矩形 工作 区 的 区 域 C 


定义 了 这 些 区 域 后 ， 由 序列 规划 器 限制 的 立足 点 条 件 (4. 2. 3 节 ) 转化 为 限 
制 区 域 。 使 用 区 域 A 限制 摆动 腿 LT 的 立足 点 ， 使 另 一 条 腿 立 即 抬 起 成 为 可 能 
(条 件 NI1、K1 和 K4)。 类 似 地 ， 使 用 区 域 B 可 以 保证 机 体 运 动 长 度 KM 后 ， 
男 一 条 腿 可 以 (条件 N2, K2, K3, K5) 抬 起 。 这 些 区 域 分 别 与 由 Hirose 
(1984) 提出 的 对 角 线 原则 (DP) 的 开 和 工 有 关 ， 但 也 有 一 些 差异 。 首 先 ， 
Horse 定义 DP I #1 DP IT 考虑 纵向 稳定 裕 度 ， 而 所 描述 的 区 域 是 考虑 到 预定 义 
绝对 稳定 裕 度 设 计 的 ， 更 适合 真正 的 步行 机 器 。 第 二 ，Hirose 使 用 DP I 和 DP MX 
用 于 后 腿 ， 而 区 域 A 和 区 域 B 定 义 用 于 相 邻 腿 的 所 有 组 合 。 最 后 ，Hirose 描述 
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了 线 和 半 和 平面， 本 章 描 述 的 区 域 实 际 是 摆动 腿 放 置 的 区 域 ， 可 保证 当 另 一 条 腿 被 
抬 起 时 机 器 的 静态 稳定 性 。 这 对 于 腿 部 布置 有 工作 区 重 玲 分 布 时 更 为 通用 。 

区 域 C 的 含义 与 区 域 A 和 区 域 B 的 含义 不 同 。 以 上 已 经 看 到 ， 当 考虑 到 标 
MEN 时 ， 后 腿 的 立足 点 必须 满足 两 个 条 件 ， 这 两 个 条 件 是 不 相 容 的 。 这 些 条 件 
由 依靠 前 腿 立 足 点 的 区 域 A 和 区 域 B 给 定 。 因 此 ， 当 寻找 其 对 侧 后 腿 的 立足 点 
时 ， 前 置 立足 点 可 以 确定 两 个 条 件 的 兼容 性 或 不 兼容 性 。Horse (1984) 使 用 通 
过 COG 的 投影 并 且 平 行 于 运动 方向 (DP Il) 的 线 限制 前 腿 的 立足 点 。 但 是 ， 
如 果 使 用 绝对 裕 度 ， 则 在 一 些 Hirose 描述 的 区 域 的 前 腿 的 放置 位 置 ， 搜 索 对 侧 
后 腿 的 立足 点 时 区 域 B 成 为 无 效 解决 方案 。 此 外 ，DP 了 不 能 确保 DP 工 和 DPI 
应 用 于 后 腿 的 兼容 性 。 通 过 使 后 腿 找 到 合适 的 立足 点 同时 满足 条 件 N1 和 条 件 
N2, C 区 被 定义 为 前 立足 点 限制 区 。 

2. 立足 点 搜索 算法 

使 用 以 下 5 个 约束 完成 立足 点 选择 。 前 4 个 约束 条 件 将 定义 新 立足 点 的 
ESZ， 而 第 5 个 约束 条 件 将 寻找 唯一 的 解 (图 4.7)。 


腿 部 工作 空间 


图 4.7 立足 点 搜索 约束 


(1) AR El: 立足 点 必须 在 腿 部 工作 空间 内 。 因 此 ， 工 作 空 间 的 水 平 投影 
将 定义 为 ESZ 的 边界 。 

(2) AR E2: 立足 点 必须 满足 序列 规划 器 制定 的 条 件 ， 以 允许 在 随后 的 步 
态 周期 中 抬 起 其 他 腿 。 这 些 条 件 列 在 4. 2. 3 节 ， 并 适用 于 本 节 上 述 立 足 点 限制 区 
域 的 形成 。 如 果 多 余 1 个 条 件 被 采用 ，ESZ 将 被 限制 在 相应 的 限制 区 域 。 

(3) 约束 E3: 立足 点 不 能 被 放置 在 禁区 内 。 因 此 ， 机 器 人 的 控制 器 应 该 能 
够 访问 由 附加 的 传感器 系统 所 提供 的 许可 /禁止 单元 的 数据 ， 例 如 在 4. 2. 2 节 解 
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释 的 。 

(4) 约束 E4: 立足 点 必须 避免 双 腿 之 间 的 碰撞 。 

应 该 测试 整 条 腿 以 避免 碰撞 ， 但 简单 起 见 只 考虑 其 中 LT 和 相 邻 的 足 和 膝盖 
的 碰撞 。 

(5) ARES: 立足 点 必须 提供 最 大 的 KM。 要 找到 最 大 KM 的 立足 点 ， 有 
必要 搜索 所 有 的 由 约束 E1 一 E4 定义 的 ESZ。 为 了 完成 搜索 ， 将 工作 空间 的 水 平 
投影 分 为 离散 点 矩阵 ， 并 选择 满足 约束 E2、E3 和 E4 的 点 。 立 足 点 由 约束 ES 给 
出 ， 选 择 具有 最 大 KM 的 点 。 用 于 将 腿 摆 动 到 新 立足 点 的 完整 程序 ， 其 中 包括 
序列 规划 器 和 立足 点 规划 器 的 算法 ， 如 算法 4. 1 一 4. 3 中 所 总 结 。 


算法 4.1 立足 点 搜索 
IF There is a leg lifted, LT, THEN 
SET NLT=leg that goes after LT in the natural sequence 
SEL JÆ 
Find a foothold for LT using CRITERION N 
WHILE A valid foothold has not been found AND J<4 
SET NLT=LKM, 
Find a foothold for LT using CRITERION K 
J=I+1 
ENDWHILE 
IF A valid foothold has been found THEN 
Place LT in the foothold 
Mark NLT as the new LT 
ELSE 
PROCEDURE FAILS 
ENDIF 
ENDIF 
EXIT 
算法 4.2 标准 N 
IF LT is a front leg THEN 
IF the leg non- adjacent to LT can be lifted with 
stability >S% after a body motion of length <KM min 
THEN SET constraint E2=Area C, KM foothold >KM min 
ENDIF 
ELSEIF LT is a rear leg THEN 
SET NLT2=rear leg contralateral to LT 
SET constraint E2=Area A f) Area B(considering NLT2) 
KM foothold > KM min 
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ENDIF 
Find a foothold accomplishing Constraints El - E5 
EXIT 


Bik 4.3 标准 开 
IF LT is a front leg THEN 
IF NLT is a front leg THEN 
SET NLT2=leg collateral to LT 
SET constraint E2= Area A f) Area B(considering NLT2) 
KM foothold > KM of NLT 
Find a foothold accomplishing constraints El - E5 
IF A valid foothold has not been found THEN 
SET constraint E2= Area A,KM foothold > KM 
of NLT 
ENDIF 
ELSEIF NLT is collateral to LT THEN 
SET constraint E2= Area B, KM foothold > KM of NLT 
ELSEIF NLT is non- adjacent to LT AND NLT will be able to go to 
transfer phase with stability > SSM after a body motion of 
length < KMmin THEN 
SET constraint E2=KM foothold > KM of NLT 
ELSE 
EXIT 
ENDIF 
ELSEIF LT is a rear leg THEN 
IF NLT is a rear leg THEN 
SET constraint E2= Area B, KM foothold > KM of NLT 
IF NLT is collateral to LT THEN 
SET constraint E2=Area A, KM of foothold > KM of NLT 
ELSEIF NLT is non - adjacent to LT THEN 
EXIT 
ENDIF 
ENDIF 
Find a foothold accomplishing Constraints E1 - E5 
EXIT 


4.2.5 机 体 运动 规划 
研究 腿 部 序列 和 立足 点 后 ， 有 必要 定义 机 体 运动 和 腿 部 提升 方法 来 充分 表征 
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步 态 。 机 体 运 动 是 以 迭代 的 方式 进行 的 。 EAT ait BLE TE EK IK IE 
代 时 移动 一 小 段 距 离 : 

(1) 所 有 的 腿 都 在 支撑 阶段 。 

(2) 所 有 的 腿 都 能 够 推动 机 体 ， 而 不 会 达到 其 运动 极限 。 因 此 ， 算 法 4.4 显 
示 机 体 运 动 规划 器 的 伪 代 码 。 


算法 4.4 机 体 运 动 规划 器 的 伪 代 码 

IF All legs are in support phase AND KM,,i, >d THEN 
Move the body a short distance d 

ENDIF 


当 一 条 腿 被 序列 规划 器 标记 为 LT， 但 稳定 性 条 件 仍 然 不 允许 这 条 腿 的 摆动 
时 ， 机 体 运动 自然 出 现 。 


4.2.6 足 抬升 规划 


足 抬 升 规划 器 是 当 所 有 的 腿 都 在 其 支撑 相 时 ， 负 责 调整 哪 一 条 腿 抬 起 的 模 
块 。 该 算法 步骤 如 下 : 

(1) 考虑 以 下 腿 的 有 序列 表 : 被 腿 部 序列 规划 器 标记 的 腿 (如 果 存 在 )、 
LKM,, LKM,, LKM,, LKM,. 

(2) 找到 列表 中 的 第 一 条 腿 LL， 它 能 够 执行 摆动 相 ， 使 得 在 KM NEZ 
前 有 大 于 S 又 的 稳定 裕 度 。 如 果 没 有 腿 满足 这 个 条 件 ， 步 态 是 锁 死 的 。 

(3) 如 果 腿 LL 可 以 抬 起 并 保证 稳定 性 在 SWE, MAE LL, 

因此 ， 由 腿 部 序列 规划 器 标记 的 腿 是 首先 考虑 要 抬 起 的 腿 。 但 是 ， 这 条 腿 可 
能 会 由 于 矫 行 角 的 变化 失去 稳定 执行 摆动 的 能 力 。 如 在 初始 情况 下 ,没有 用 于 拾 
起 的 腿 。 在 这 些 情况 下 ， 考 虑 其 他 腿 的 抬 起 ， 以 运动 裕 度 升序 给 出 顺序 。 足 抬升 
规划 器 的 伪 代 码 见 算法 4. 5。 


算法 4.5 抬 起 规划 器 的 伪 代 码 
IF All legs are in support state THEN 
IF The sequence planner has marked a leg as LT AND-LT will be 
able to go to transfer phase with stability > Sgy after a 
body motion of length < KM min 
THEN SET LL=LT 
ELSE 
SET N=1 
WHILE N<=4 
IF LKMy will be able to go to transfer phase with 
stability > S3M after a body motion of length < KM min 
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THEN SET LL=LKMy 
BREAK WHILE 
ELSE 
N=N+1 
ENDIF 
ENDWHILE 
ENDIF 
IF leg LL can be lifted currently with stability > S% 
THEN Lift leg LL 
ENDIF 
ENDIF 
EXIT 


4.3 ”自由 转弯 步 态 


本 节 提 出 了 一 种 从 自由 多 行 步 态 得 出 的 转弯 步 态 。 在 这 个 转弯 步 态 中 ， 机 体 
参考 坐标 系 围 绕 给 定点 跟踪 圆 形 的 轨迹 。 直 线 轨迹 可 以 被 认为 是 转动 半径 无 限 大 
的 转弯 步 态 。 所 以 ， 用 来 规划 步 态 的 方法 应 该 在 半径 足够 大 的 转弯 步 态 中 也 有 
效 。 但 是 ， 必 须 重 新 定义 某 些 概念 和 定义 。 定 义 轨迹 的 参数 (应 由 操作 者 或 优先 
的 层级 给 出 ) 如 下 : 

(1) 转弯 中 心 TC: 机 体 圆 形 轨迹 的 中 心 ， 在 机 体 参 考 坐 标 系 中 定义 其 
分 量 。 

(2) 转弯 方向 TD: 显然 转弯 的 方向 是 顺 时 针 或 逆 时 针 。 

G) 转弯 半径 TR: 转弯 中 心 TC 到 机 体 参考 坐标 系 原点 的 距离 。 

(4) 转弯 中 心 角 Orc: 由 通过 COG 和 TC 的 线段 和 机 体 参考 坐标 系 x 轴 形成 
的 角度 。 

(5) 转弯 蟹 形 角 or: 机 体 参 考 坐 标 系 原点 轨迹 的 切线 和 z 轴 形 成 的 角度 。 
沿 着 轨迹 保持 此 角度 恒定 。 


r+» 如 果 是 顺 时 针 转 向 
(4. 16) 
am 
2 » 


orc 一 如 果 是 逆 时 针 转 向 


此 外 ,运动 学 裕 度 必须 重新 定义 。 

(6) EMARE ur: 到 达 腿 工作 空间 的 边界 之 前 ， 一 条 腿 的 立足 点 以 
相反 方向 绕 TC 到 TD 扫 过 的 角度 (图 4. 8) 。 

应 该 根据 jr 的 定义 重新 定义 一 些 其 他 概念 “KM,、LKMi 等 )。 另 外 ， 对 
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图 4.8 ”运动 裕 度 角 
于 自由 的 蟹 行 步 态 一 些 描述 必须 重新 制定 以 产生 转弯 步 态 。 这 些 修 改 将 在 接 下 来 
的 两 节 中 进行 描述 。 
4.3.1 腿 部 序列 、 机 体 运动 和 腿 部 抬 起 


PRA AFB BEA (4. 2.3 节 、4.2.5 WA 4.2.6 节 ) 腿 部 规划 序列 、 
机 体 运 动 和 腿 抬 起 的 方法 ， 对 自由 转弯 步 态 也 是 有 效 的 ， 并 用 mr 代替 KM。 步 
态 的 类 型 和 每 条 腿 的 职责 ， 例 如 右 、 左 、 前 和 后 ， 确 定 是 ur 的 函数 ， 而 不 是 a 
的 函数 。 如 果 4. 2. 5 节 的 条 件 满 足 ， 那么 在 每 次 算法 迭代 时 ， 机 体 以 固定 的 很 短 
的 距离 绕 TC 旋转 。 为 了 完成 这 个 动作 ， 腿 必须 在 相反 方向 位 置 旋转 。 


4.3.2 立足 点 规划 


用 于 规划 自由 艇 行 步 态 的 新 立足 点 的 方法 必须 部 分 适用 于 转弯 步 态 。 在 
4. 2. 4 节 立 足 点 限制 区 域 B 和 区 域 C 的 描述 将 重新 定义 为 区 域 BT 和 区 域 CT， 
它们 可 以 用 于 转弯 步 态 。 
(1) 区 域 BT: 该 区 域 相当 于 区 域 B， 假 定 该 区 域 COG 位 于 COGmr 点 ， 结 
果 是 COG 在 运动 方向 上 以 角度 v 绕 转向 中 心 旋转 (图 4. 9) 。 由 下 式 给 出 
COGsr; = TC, — TReos(0rc—») 
(4.17) 
COGsr, = TC, — TRsin (brce — v) 
可 以 在 式 (4.7) Ast (4.8) 中 通过 插入 新 的 COG 位 置 来 确定 线 BT1 MA 
BT2。 类似 地 ， 可 以 从 式 (4.9) 中 获得 区 域 BT。 
(2) 区 域 CT: 用 于 确定 区 域 CT 的 流程 与 描述 区 域 C 相似 ， 具 有 以 下 差异 : 
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COGaT 


机 器 人 轨迹 


\ 
\ 
\ 
| 
| 


TC ; 
线 BT1 线 BT2 


图 4.9 线 BTl MA BT2 以 及 转弯 步 态 中 的 
区 域 BT 的 定义 


1) o: 稳定 地 抬 起 后 腿 V 时 机 体 所 需 的 最 小 角 位 移 (图 4. 10)。 要 做 到 这 一 
点 ，COG 必须 移 至 COGcr 点 ， 由 下 式 定 义 


pT (PB) pt (Pa) 
U 
aa BT 
2 Jr 


Pr 


TC 


图 4.10 计算 定义 区 域 CT 的 点 PA 
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St er eee ee eee > 
Se LOG Soe Pee) ae 
COGer =mCOGer, +k + TC, 
其 中 

R 王 Pu 一 MP 十 dam Vm F1— TC, (4. 19) 

da 一 de， 如 果 转 向 方向 是 顺 时 针 的 
| 如 果 转 向 方向 是 逆 时 针 的 (4. 20) 

ldn|=1 


m 可 从 式 (4.12) 得 到 。 选 择 参 数 du 的 符号 ， 使 解决 方案 满足 以 下 条 件 之 一 : 


mCOGer, +b>COGer, ’ 如 果 Py, —mPy,<0 (4 21) 
laced. +b<COGer,, 如 果 Py, —mPy, >0 ` 
一 旦 确定 点 COGcr ， 角 度 为 
2 一 x ~ pp ë sp 
SEREN TRTO COG TC COG, ares 


TR? 
2) o: BT (放置 在 Pr) 和 腿 U 的 最 小 pr. 
3) Jr 点 坐标 为 
Jr, = (Pr,— TC, ) cosp— (Pr — TC, ) sing+ TC, 
J ty= (Pr. — TC,) sing+ (Pr, — TC, ) cosp+ TC, (4. 23) 
假设 腿 工 放 在 Jr 上， 可 以 计算 出 线 Al 以 及 当 LT=V. NLT=U 和 v=p 一 9 
时 的 线 BT1 (Al 4. 10)。 区 域 CT 的 极限 点 由 PT HE, R Al MA BTI 的 斜率 
相等 。 


4.4 自由 旋转 步 态 


自由 旋转 步 态 或 零 半 径 自由 转弯 步 态 使 机 体 绕 机 体 参 考 坐 标 系 的 轴 旋 转 ， 
因此 转弯 中 心 位 于 COG 处 ， 转 弯 半 径 为 零 。 这 个 步 态 提 供 了 改变 机 器 人 方向 的 
一 个 有 效 方法 ， 避 免 当 转弯 半径 小 时 转向 步 态 跟随 轨迹 时 产生 死 点 。 与 以 前 的 步 
态 算法 一 样 ， 步 态 指定 腿 部 序列 、 立 足 点 选择 和 机 体 运 动 。 


4.4.1 腿 部 序列 和 腿 部 抬 起 


为 了 获得 最 大 摆动 腿 数量 的 大 旋转 角度 ， 选 择 了 一 个 圆 形 腿 序 列 ， 当 机 体 顺 
时 针 GRATE) 转动 时 ， 腿 以 顺 时 针 〈 逆 时 针 ) 依次 进入 摆动 相 。 最 初 ， 该 算法 
判断 是 否 可 以 稳定 地 抬 起 其 中 至 少 一 条 腿 ， 并 具有 比 St KW EAS ARE. UR AS 
能 ， 机 体 沿 着 运动 方向 到 最 终 的 仍 行 角 ， 直 到 腿 部 可 以 稳定 地 抬 起 。 这 个 操作 需 
要 在 步 态 算法 开始 时 执行 ， 因 为 立足 点 将 永远 保证 下 一 条 腿 稳定 地 抬 起 。 摆 动 腿 
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将 被 强加 以 下 约束 : 

G) 腿 可 以 静态 稳定 地 抬 起 。 

(2) 在 旋转 方向 上 的 相 邻 腿 不 能 被 抬 起 直到 静态 稳定 。 

后 一 种 情况 意味 着 足 始 终 位 于 不 在 旋转 方向 上 过 度 前 进 的 位 置 。 这 将 有 利于 
立足 点 搜索 。 


4.4.2 立足 点 规划 和 机 体 运动 规划 


摆动 腿 LT 的 新 立足 点 将 受到 如 下 序列 条 件 的 限制 : 

条 件 S1: LT 的 立足 点 必须 能 够 稳定 地 沿 旋转 方向 抬 起 下 一 条 腿 。 因 此 ， 
ESZ 将 受到 区 域 A 限制 ，LT 在 旋转 方向 之 后 为 NLT。 

条 件 S2: LT 放置 的 立足 点 须 满足 ， 当 搜索 与 LT 不 相 邻 的 腿 的 立足 点 〈 即 
稍 后 摆动 的 两 条 腿 ) 时 ， 条 件 Sl 须 与 工作 空间 施加 的 约束 兼容 。 

如 上 所 述 ， 条件 Sl 意味 着 LT 的 立足 点 必须 在 区 域 A 内 。 该 区 域 取 决 于 
LT 不 相 邻 的 腿 部 位 置 。 如 果 与 LT 不 相 邻 的 腿 位 于 某 些 位 置 ， 那 么 区 域 A 和 施 
加 在 腿 部 工作 区 的 约束 可 能 不 兼容 。 通 常 ， 如 果 与 LT 不 相 邻 的 腿 处 于 在 过 度 旋 
转 的 位 置 ， 则 位 于 此 位 置 会 出 现 不 兼容 性 。 条 件 S2 是 旨 在 确定 以 这 种 方式 摆动 
腿 的 立足 点 ， 在 两 次 摆动 之 后 不 兼容 不 会 出 现 。 这 个 条 件 是 通过 使 用 如 下 限定 区 
域 DS 的 立足 限制 来 实现 的 。 

区 域 DS: 由 线 定义 的 不 包含 COG 的 半 平 面 ， 即 

y=Lal(G,.G,.0,0,5.x) 
LULL: ie 
—1, Rime winter 

其 中 (G, G) 是 随机 选择 的 点 。 以 这 样 的 方式 ， 区 域 DS 和 不 相 邻 腿 到 
LT 的 工作 空间 交叉 的 斥 才 等 同 于 预先 定义 的 最 小 搜索 区 域 (图 4. 11)。 这 样 就 
能 保证 在 两 次 摆动 以 后 ， 不 相 邻 的 腿 到 LT 立足 点 的 搜索 应 用 条 件 S 和 工作 空 
间 约 束 将 产生 最 小 的 有 效 搜索 区 域 ， 尽 管 这 些 摆 动 相 之 间 没 有 产生 机 体 旋 转 。 

Kik A 和 区 域 DS、 腿 部 工作 区 、 禁 区 和 腿 部 碰撞 区 域 定义 了 与 蟹 行 步 态 
ESZ 非常 相似 的 ESZ。 选 择 立 足 点 的 步骤 与 蟹 行 步 态 相同 ， 除 此 之 外 ， 它 搜索 
最 大 的 pr 而 不 是 最 大 的 KM, 

如 果 在 这 些 条 件 下 不 能 找到 一 个 立足 点 [图 4.12 (a)]， 则 采用 两 种 方法 来 
执行 立足 点 搜索 以 避免 死 点 : 

(1) 如 果 没 有 找到 有 效 的 立足 点 ， 则 摆动 腿 被 抬 起 ， 机 体 在 3 条 腿 支 撑 下 旋转 ， 
直到 最 小 yr 达到 腿 部 运动 限制 [图 4. 12 (b)]， 然 后 进行 新 的 搜索 [图 4. 12 o 

(2) 如 果 这 样 的 机 体 运动 不 可 能 ， 那 么 条 件 S2 就 被 忽略 了 ， 其 目的 是 为 后 
续 的 步 态 周期 执行 新 的 搜索 以 获得 良好 的 结果 [图 4.12 (d)]。 
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最 小 预定 义 
搜索 区 域 


图 4.11 旋转 步 态 的 区 域 DS 和 有 效 搜索 区 域 ESZ 


Wa 


\. GLT Q 2 
“a er at 


O 进行 新 的 搜索 (d) 获得 良好 结果 
图 4.12 通过 3 条 腿 支撑 下 的 旋转 机 体 寻 找 立 足 点 
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在 每 次 腿 摆动 之 后 ， 机 体 尽 可 能 旋转 ， 即 直到 最 小 jwrwis 的 腿 达 到 其 运动 极 
限 。 这 种 做 法 腿 部 将 被 位 于 旋转 方向 上 不 太 靠 前 的 位 置 ， 有 利于 寻找 新 的 立足 点 
并 减少 死 点 的 可 能 性 。 旋 转 步 态 的 完整 算法 介绍 见 算法 4. 6。 


算法 4.6 旋转 步 态 的 伪 代 码 
LABEL A: 
Rotate the body an angle equal to germin 
SET LT= a leg that can be lifted with stability and the leg after 
it in the direction of rotation cannot 
Find a foothold for LT satisfying conditions S1 and S2 
IF a valid foothold has not been found THEN 
IF xr >0 THEN 
Lift leg LT 
GO TO LABEL A 
ENDIF 
Find a foothold for LT satisfying conditions S1 
IF a valid foothold has not been found THEN 
PROCEDURE FAILS 
EXIT 
ENDIF 
ENDIF 
Place LT at the foothold found 
EXIT 


4.5 实验 结果 


本 章 介 绍 的 算法 在 SILO4 步行 机 器 人 上 进行 了 深入 的 模拟 测试 。 在 这 里 仅 
介绍 两 个 实验 ， 每 个 实验 都 包含 在 不 同 条 件 下 遵循 预定 义 的 路 径 。 虽 然 这 个 路 径 
已 经 预 编程 ,实验 相当 于 人 类 操作 者 在 操作 机 器 人 时 引导 机 器 人 走路 。 预 定义 的 
路 径 由 表 4. 1 中 4 条 直线 段 组 成 ， 由 世界 参考 坐标 系 x 轴 的 初始 点 和 和 钨 行 角 定义 
(图 4.13)。 机 器 人 的 初始 足 位 置 在 机 体 参 考 坐 标 系 位 置 为 

Cari» yeu.) = (0. 3m,0. 3m) 
(Err » YFRL) = (0. 3m, — 0. 3m) 
(TRLL» yr) = (— 0. 3m,0. 3m) 
Carri > Yr) = (—0. 3m, —0. 3m) 
并 且 机 体 参考 系 平行 于 世界 参考 坐标 系 。 实 验 中 所 需 的 SM 为 0. 04m, 
机 器 人 的 位 置 通过 测量 估算 获得 ， 即 控制 器 仅 考虑 到 腿 部 和 机 体 运 动 ， 计 算 
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初始 足 位 置 /m 理论 长 度 /m | 实际 长 度 /m | 平均 速度 /(m，s 1!) 


1 (0. 400，0. 600) 1. 500 1.551 0. 0097 
2 (1. 900, 0. 600) 0. 760 0.774 0. 0053 
3 (2.559, 0. 897) 0. 900 0. 948 0. 0059 


(2.559, 1.779) 0. 800 0.777 0. 0049 


图 4.13 SILO4 机 器 人 跟踪 预定 义 的 路 径 


在 世界 参考 系 的 位 置 。 用 基于 数码 相机 的 外 部 测量 系统 记录 足 端 和 机 体位 置 以 及 
实验 结果 。 

机 器 人 在 平坦 的 地 形 上 进行 实验 。 值 得 注意 的 是 ， 对 不 规则 地 形 的 适应 性 是 
不 连续 步 态 的 潜在 特征 。 

在 第 一 个 实验 中 ， 机 器 人 使 用 自由 蟹 行 步 态 跟 随 轨 迹 ; 因此 ， 机 体 参 考 坐 标 
系 的 二 轴 总 是 相同 的 方向 。 机 器 人 沿 着 3. 96m 的 完整 轨迹 移动 ， 需 要 7. 5min。 
外 部 测量 系统 每 15s 拍摄 一 张 照片 。 处 理 后 ， 绘 制 如 图 4.13 所 示 的 轨迹 。 虚 线 
表示 机 器 人 跟随 的 原始 轨迹 。 真 正 的 轨迹 与 理论 轨迹 在 轨迹 终点 偏离 了 约 0. 10m 
( 约 4m 长 )。 出 现 此 错误 是 因为 基于 测量 的 机 器 人 位 置 估计 只 考虑 了 理论 位 移 ， 
并 没有 考虑 到 与 机 体 、 腿 部 弯曲 和 足 滑 动 等 相关 的 参数 。 需 要 额外 的 传感器 来 解 
决 这 个 问题 ， 这 超出 了 本 章 的 范围 。 表 4. 1 总 结 了 实验 期 间 的 机 体位 移 和 速度 。 

第 二 个 实验 包括 带 禁 止 区 域 的 相同 的 路 径 ， 如 图 4. 14 所 示 。 机 器 人 控制 器 
知道 所 有 这 些 区 域 的 大 小 和 位 置 ， 用 于 步 态 生成 。 机 器 人 不 能 踩 在 阴影 区 域 。 所 
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以 有 效 禁 止 区域 应 该 在 所 有 方向 上 按 足 部 直径 放大 。 该 有 效 面 积 用 图 4. 14 中 的 
细 线 表示 。 

为 了 显示 算法 的 工作 原理 ， 图 4.14 显示 3 种 不 同情 况 的 足 端 支撑 点 。 图 
4.14 (a) 显示 了 第 一 次 实验 第 一 次 伸展 的 足 支撑 点 ， 即 机 器 人 跟踪 没有 禁区 的 
直线 。 图 4.14 (b) 显示 了 模拟 得 到 的 带 禁 止 区 域 的 ， 在 执行 相同 轨迹 时 的 足 端 
支撑 点 。 在 这 种 情况 下 ， 很 容易 观察 到 ， 在 禁止 区 域 没有 任何 支撑 点 。 图 4. 14 
(c) 说 明了 当 机 器 人 执行 轨迹 时 ,通过 定义 的 禁止 区 域 的 真正 支撑 点 。 足 端 支撑 
点 稍微 偏离 模拟 中 获得 的 点 [图 4. 14 (b)]， 这 是 因为 机 器 人 位 置 是 基于 测量 估 
算 的 方法 。 


Co) 通过 定义 的 禁止 区 域 的 真正 支撑 点 
图 4.14 针对 不 同情 况 的 禁区 的 足 端 支撑 点 


部 分 “步行 测量 和 算法 


4.6 结论 


本 章 介绍 了 实际 步行 机 器 3 种 新 步 态 的 行走 方法 ， 能 够 适应 不 规则 的 地 形 ，。 
蟹 行 步 态 、 圆 形 步 态 和 旋转 步 态 可 以 连接 在 一 起 ， 以 有 效 地 跟随 复杂 路 径 。 这 些 
新 步 态 是 基于 自由 步 态 和 不 连续 步 态 。 自 由 步 态 适合 跟踪 轨迹 ， 不 连续 步 态 具有 
良好 的 地 形 适 应 性 。 

自由 步 态 的 算法 是 基于 保持 机 器 人 静态 稳定 和 避免 腿 部 锁 死 的 同时 便于 实现 
腿 部 序列 的 启发 式 规则 。 新 的 立足 点 限制 区 域 是 基于 Hirose 的 工作 ,并 考虑 绝 
对 稳定 裕 度 来 规划 立足 点 ， 以 实现 一 些 腿 部 序列 准则 。 特 别 是 在 艇 行 步 态 和 转弯 
步 态 用 于 限制 前 腿 的 立足 点 区 域 时 代表 了 一 种 新 的 有 效 的 方法 。 

新 步 态 的 特性 理论 上 优 于 以 前 的 步 态 ， 由 于 采用 了 绝对 的 稳定 裕 度 ， 使 得 真 
正 的 机 器 下 在 任何 镭 行 角 都 能 以 稳定 的 方式 行走 。 最 后 ， 使 用 不 连续 步 态 为 不 规 
则 的 地 形 适 应 问题 提供 了 简单 的 解决 方案 。 

本 章 报 告 了 一 些 实验 结果 来 验证 理论 和 所 提出 步 态 的 实际 性 能 。 通 过 STLOA 
步行 机 器 人 实验 证 明 算 法 是 有 效 的 。 
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防 第 5 章 新 的 稳定 性 方法 


5.1 简介 


前 几 章 研究 了 不 同 的 静态 稳定 裕 度 和 动态 稳定 裕 度 来 推断 出 步行 机 器 人 上 距离 
不 稳定 的 程度 。 这 些 裕 度 基 于 几何 或 能 量度 量 ， 其 假定 理想 的 致 动 器 和 理想 的 能 
量 供应 ， 即 致 动 器 有 提供 任何 要 求 转 和 矩 的 能 力 和 任何 要 求 电 流 的 电池 。 然 而 ， 真 
正 的 电机 是 受 转 和 矩 限 制 ， 实 际 能 量 模块 只 能 提供 有 限 的 最 大 电流 。 因 此 ， 仅 使 用 
机 器 人 的 几何 参数 的 稳定 性 度量 ,实际 上 忽略 了 系统 的 电机 转 矩 和 功 耗 限制 的 影 
响 ， 对 于 在 实际 应 用 中 工作 的 机 器 人 来 说 是 十 分 不 便 的 。 

本 章 介绍 了 步行 机 器 人 的 静态 稳定 理论 ， 通 过 真正 的 步行 机 器 模拟 和 实验 考 
虑 了 机 器 人 的 内 在 参数 静态 稳定 的 新 概念 。 从 机 器 人 设计 和 能 量 消耗 两 方面 得 到 
的 稳定 性 度量 可 以 提高 效率 ， 上 述 两 个 方面 在 自主 行走 机 器 人 实际 应 用 中 具有 重 
要 的 意义 。 

因为 腿 通常 设计 为 3 自由 度 操纵 器 ， 其 受 限于 致 动 器 特性 和 电源 特性 限制 。 
机 器 人 操纵 器 定义 了 给 定 的 工作 空间 ， 并 为 所 需 特征 选择 电机 功率 ,例如 最 大 有 
效 载荷 和 速度 。 电 机 重量 对 于 操纵 器 来 说 不 是 个 大 问题 ， 电机 在 结构 内 容易 平 
衡 ， 总 重量 直接 由 地 面 支撑 或 通过 坚固 的 结构 支撑 (Gonzalez de Santos 等 ， 
2005). 

步行 机 器 人 存在 另 一 些 问题 。 腿 需要 : D 有 一 个 工作 空间 ， 确 保 它们 的 立足 
点 〈 考 虑 禁止 区 域 )，@ 支 撑 机 体 和 有 效 载 荷 ，@ 越 过 障碍 物 。 

这 意味 着 一 条 腿 可 能 需要 长 连 杆 ， 不 是 为 了 更 大 的 工作 空间 ， 而 是 为 了 越过 
障碍 。 因 此 ， 腿 不 需要 确保 在 整个 工作 空间 的 大 转 和 矩 ， 而 是 要 求 它们 在 整个 工作 
空间 部 分 区 域内 具有 人 额定 的 转 矩 。 这 种 现象 在 自然 界 中 较 普遍 ， 有 腿 的 动物 正常 
行走 时 不 使 用 腿 的 整个 工作 空间 ， 正 常 的 腿 部 工作 空间 小 于 可 达 的 工作 空间 。 例 
如 ， 一 个 人 一 条 腿 拥有 较 大 的 工作 空间 ， 但 在 行走 期 间 只 使 用 较 小 的 工作 空间 ， 
因为 他 无 法 承受 一 些 极端 位 置 肌肉 所 需 的 力量 。 这 一 事实 鼓励 研究 人 员 开 发 机 构 
和 算法 以 减少 躁 关节 的 力量 ,例如 Yi 和 Zheng (1997) 。 

步行 机 器 人 遇 到 同样 的 问题 。 致 动 器 在 正常 位 置 可 施加 给 定 的 力 。 然 而 ， 当 
一 个 立足 点 处 在 正常 位 置 之 外 ， 关 节 需 求 的 转 矩 可 能 会 比 由 致 动 器 可 施加 的 最 大 


103 


一 部 分 “步行 测量 和 算法 


转 矩 更 大 ， 因 此 腿 不 会 可 靠 地 支撑 机 体重 量 ， 机 器 人 可 能 会 摔 倒 。 这 个 问题 通常 
不 会 出 现在 步行 机 器 人 在 平坦 地 面 执行 周期 步 态 (第 3 章 )。 周 期 步 态 使 用 位 于 
一 个 在 工作 空间 内 ， 有 利于 减少 工作 空间 面积 的 足 端 轨迹 。 然 而 ， 自 由 步 态 使 用 
整个 腿 部 工作 空间 的 宽度 和 跨度 ， 自 由 步 态 在 任何 方向 上 放置 足 端点 ， 以 实现 更 
好 的 速度 和 全 方位 性 〈 第 4 章 )。 因 此 ， 减 小 工作 空间 是 不 可 接受 的 解决 方案 ， 
它 降低 了 机 器 人 的 平均 速度 (取决 于 腿 部 步 幅 )， 因 为 步行 机 器 人 本 质 上 是 速度 
较 慢 的 机 器 ， 速 度 必须 尽 可 能 地 高 。 而 且 ， 还 需要 考虑 其 他 问题 ， 例 如 由 足 施 加 
的 力 〈 力 实际 上 由 关节 转 矩 产生 的 ) 不 仅 取决 于 该 足 的 位 置 ， 也 取决 于 其 他 所 有 
的 足 。 最 佳 解 决 方案 似乎 是 考虑 真实 机 器 人 所 有 关节 的 关节 转 矩 ， 并 避免 这 些 腿 
部 的 任 一 个 关节 转 矩 高 于 最 大 允许 转 矩 。 而 且 并 不 止 这 一 个 约束 ， 即 使 在 机 器 人 
所 有 关节 转 矩 低 于 最 大 允许 的 情况 下 ， 功 耗 可 能 高 于 电源 或 板 载 电子 设 备 允 许 的 
最 大 值 。 请 注意 ， 电 力 是 自主 机 器 人 中 非常 有 限 的 资源 功 耗 ， 因 此 功 耗 优化 势 在 
必 行 。 

正如 在 第 2 WR, 稳定 由 几何 方法 定义 ; 步行 机 器 如 果 其 重心 的 投影 位 于 
机 器 的 支撑 多 边 形 内 是 稳定 。 该 定义 假设 致 动 器 可 以 提供 任何 要 求 的 转 矩 。 然 
而 ， 真 正 的 致 动 器 是 电源 和 电子 设备 ， 因 此 稳定 的 概念 相应 地 应 该 被 重新 定义 。 

本 章 阑 述 了 这 个 实际 问题 ， 并 提出 了 一 个 新 的 静态 稳定 性 概念 ， 以 提高 实际 
步行 机 器 人 的 效率 。5. 2 节 提 出 问题 和 方法 。5. 3 节 和 5.4 节 分 别 研究 了 在 模拟 
和 实际 步行 机 器 人 中 使 用 几何 稳定 性 标准 的 一 些 效果 。5. 5 节 推 荐 全 局 稳定 性 标 
4E, 5.6 节 总 结 了 一 些 结论 。 


5.2 JUA Fe ne PERI DT hs FE 


由 机 器 人 施加 的 腿 力 取决 于 支撑 腿 的 数量 和 其 立足 点 。 四 足 机 器 人 在 静态 下 
行走 必须 3 条 腿 一 组 交替 支撑 (8 二 3/4)， 或 以 3 条 腿 和 4 条 腿 的 支撑 序列 支撑 
(B>3/4) (第 3 Ñ). 

机 器 人 机 体 的 力 和 力矩 平衡 方程 为 (Klein 和 Chung, 1987) 


A3x,F=W (5. 1) 
其 中 
Wy Dy a i 
ae yo ys 3 (5x2) 
1 1 1 1 
F=(F,,F,,F3,F,)* (5.3) 
W=(0,0,—W)' (5. 4) 


F; 是 i 足 垂直 地 面 的 反作用 力 (一 F; 是 i 足 必须 施加 在 地 上 的 力 )，(zi,y;) 
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是 位 于 机 器 人 参考 系 (zx,y,zx) PME i 的 组 件 在 机 体重 心 的 位 置 ，W 是 机 器 人 
的 重量 。 

式 (5.1) 是 一 个 不 确定 的 系统 ， 因 为 它 有 3 个 组 成 方程 和 4 个 未 知 数 
(F;)， 其 解决 方案 可 以 通过 As, Kawi As... BI 


A3xs =A3gxa (Asxs Aix) ! (C5. 5) 
其 中 4 表示 4 的 转 置 矩阵 。 因 此 ， 如 果 所 有 足 都 在 支撑 ， 则 足 部 力量 为 
F=Aju.W= Abu (Asx Aix) 'W (5. 6) 
如 果 机 器 人 有 3 条 腿 支 撑 ， 式 (5.1) 可 以 写成 
A;x3F=W (5.7) 
其 中 
Dy Ap BH l 
=i yr (5. 8) 
| a es 
F=(F,,F,,F.)* (5. 9) 
Ww=(0,0,—W)! (5. 10) 
4 HAL“ det(A)A0 If, A 的 逆 和 矩阵 存在 ， 足 力 有 一 个 唯一 的 解 ， 即 
F, wt. he Ea ey a0 
5 E a “ é i. (5.11) 
F,=0 


其 中 gq、r 和 s 表示 支撑 的 腿 ，: 是 摆动 的 腿 。 

因此 ， 对 于 四 足 不 连续 步 态 ， 机 体 运 动 的 足 力 可 通过 式 (5.6) 计算 ,而 当 
腿 处 于 摆动 相 时 由 式 (5.11) 计算 足 力 。 图 5. 1 绘制 了 SILO4 机 器 人 每 个 支撑 
腿 施加 力 执 行 6=7/9 的 不 连续 步 态 ， 步 态 图 如 图 3.7 (a) 所 示 。 没 有 足 力 意味 着 
腿 处 于 摆动 阶段 ， 机 体 运 动 发 生 时 ， 力 是 线性 转变 的 CHE 上 一 0.5 和 三 1 之 前 )。 

实际 上 必须 通过 取决 于 腿 部 构 型 的 关节 转 抢 来 施加 支撑 力 。 这 意味 着 在 一 条 
腿 施加 一 定 力 的 情况 下 ， 在 不 同 腿 部 构 型 下 具有 不 同 关节 的 转 矩 。 关 节 转 和 矩 矢 量 
为 地 面 反 作用 力 的 函数 ， 由 (Spong 和 Vidyasagar, 1989) 给 出 

t=J'F,; CS. 12) 

HP r; = (ratata) ÆR i 的 关节 转 和 矩 和 撩 量 ，F; 是 地 面 对 足 i 的 反作用 力 ， 
J 是 相应 腿 部 构 型 的 雅 可 比 矩 阵 ( 附 录 A)。 转 矩 六 必须 由 致 动 器 提供 以 保持 机 
器 人 平衡 ， 否 则 就 会 跌倒 。 

图 5. 2 绘制 了 不 连续 步 态 的 最 后 一 个 例子 (8 二 7/9)， 所 有 关节 根据 运动 所 
需 施 加 相应 的 转 矩 ， 其 中 时 间 归 一 化 为 步 态 周 期 。 在 本 例 中 ， 机 器 人 水 平 的 ， 每 
条 腿 上 的 关节 1 是 不 需要 施加 任何 转 矩 的 。 实 线 和 虚线 分 别 代 表 关 节 2 和 关节 3 
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0 0.5 1.0 0 0.5 1.0 
归 一 化 时 间 归 一 化 时 间 
图 5.1 沿 不 连续 步 态 的 足 力 (B=7/9) 
20 


一 20 


腿 1 的 关节 扭矩 /Nm 
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—— 


腿 2 的 关节 扭 撼 /Nm 


BE 3 的 关节 扭矩 /Nm 


g 
£ 
NI IAA = d 
ieee. A de 
IE Mf ip : eae \z 
W zol- ee | 
z 1 
4% 1.0 
归 一 化 时 间 
mt 1 一 一 关节 2 一 一 -关节 3 


图 5.2 沿 不 连续 步 态 (B=7/9) MKT 


中 的 转 矩 ， 根 据 步 态 相 位 以 不 同 的 程度 支撑 身体 。 施 加 给 定 足 力 的 关节 转 矩 取决 
于 腿 部 构 型 ， 如 上 所 述 : 因此 ， 关 节 转 矩 也 强烈 依赖 与 立足 点 位 置 。 腿 部 工作 空 
间 应 足够 大 ， 以 增强 稳定 性 或 避免 禁止 区 域 。 在 这 种 情况 下 ， 转 矩 可 能 增加 ， 如 
图 5.3 所 示 。 图 5. 3 绘制 了 在 3 种 不 同 的 情况 下 ， 前 腿 关节 2 ee E 1 和 腿 
2)。 后 腿 重复 这 些 力 的 模式 只 是 延迟 半 周 期 。 在 情况 A 中 ， 一 个 立足 点 在 轨迹 
上 位 于 距 机 体 矢 状 面 0.45m 处 。 在 情况 B 中, 足 1 和 足 3 距 离 机 体 矢 状 面 
0. 5m， 而 足 2 和 足 4 位 于 0.35m (工作 空间 与 矢 状 平面 最 接近 的 极限 )。 最 后 ， 
在 情况 C 中 ， 所 有 是 位 于 矢 状 面 0. Sm 处 (图 5.4)。 

为 了 更 好 地 理解 这 些 图 ， 表 5. 1 显示 了 所 有 3 种 情况 下 的 最 大 值 ， 前 腿 (1 


a 
© 


40 


20 


腿 1 的 关节 转 矩 /Nm 


60 


腿 2 的 关节 转 矩 /Nm 


0 0.2 0.4 0. 6 0. 8 1.0 
归 一 化 时 间 


(b) 情况 B 


图 5.4 SILO4 步行 机 器 人 的 不 同 腿 部 姿态 
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足 位 置 /m 
关节 转 矩 2/(N + m) 
关节 转 矩 3/(CN 。 


和 2) 为 每 个 关节 的 转 矩 。 从 表 5. 1 可 以 看 出 ， 在 情况 C 中 ,关节 2 中 的 转 矩 大 
于 情况 A 和 情况 B 下 的 转 矩 。 在 情况 A 中 ， 转 矩 较 低 ， 因 为 立足 点 靠近 矢 状 面 。 
在 情况 B 中 ， 右 腿 (2 和 4) 的 关节 2 的 转 矩 由 于 特定 的 足 力 分 布 甚至 可 能 低 于 情况 
A。 因 此 可 以 得 出 结论 ， 如 果 机 器 设计 为 如 情况 A 下 支撑 转 矩 最 大 [图 5.4 (a). Ap 
么 腿 部 工作 空间 将 非常 小 ， 就 不 可 能 得 到 像 腿 B 这 样 的 布局 [图 5.4 (b)]， 因 
为 其 对 于 左 腿 需要 较 大 的 腿 部 延伸 并 且 对 关节 2 需要 较 低 的 转 矩 。 相 反 ， 如 情况 
C [图 5.4 (c)] 选择 电机 以 施加 转 矩 ， 可 能 需要 较 重 的 电机 和 齿轮 ， 从 而 降低 
机 器 人 的 性 能 。 需 要 注意 的 是 ， 电 机 功率 选择 并 不 是 连续 的 。 电 机 功率 通常 是 离 
散 的 ， 增 加 转 矩 要 求 更 大 的 电机 类 型 ， 从 而 也 增加 了 重量 。 还 有 一 个 问题 是 步行 
机 器 需要 携带 不 同 的 有 效 载荷 。 从 几何 角度 来 看 机 器 是 稳定 的 ， 但 是 可 能 有 效 载 
荷 很 高 ， 或 者 要 求 的 转 抢 或 功率 消耗 比 允 许 的 最 大 值 更 高 。 下 面 论 述 这 种 影响 。 


5.3 考虑 有 限 的 电机 转 和 矩 影 响 : 模拟 研究 


本 节 不 考虑 几何 稳定 性 ， 仅 考虑 由 于 转 矩 的 限制 对 稳定 的 重要 性 ， 通 过 仿真 
分 析 ， 从 致 动 器 的 力矩 限制 〈 转 矩 极限 稳定 性 ) 来 说 明 。 在 这 里 用 于 模拟 的 模拟 
软件 包 见 附录 B。 主 要 思想 是 观察 在 机 器 人 关节 (理想 的 致 动 器 ， 中 没有 转 矩 限 
制 时 ， 机 器 人 在 穿 过 直线 时 的 行为 ， 并 且 将 其 与 在 其 所 有 关节 〈 实 际 致 动 器 ) 中 
具有 转 矩 限制 时 执行 相同 的 轨迹 进行 比较 。 

SILO4 模拟 模型 跟踪 一 条 直线 沿 着 x 轴 保 持 恒 定 的 高 度 (z 分 量 ) 并 执行 不 
连续 步 态 。 足 端 轨迹 如 图 5. 4 中 情况 C 所 示 。 

图 5. 5 绘制 了 每 个 关节 在 定义 轨迹 过 程 中 施加 的 转 矩 。 细 线 步 长 0.4m, A 
阶 高 0. 1m。 腿 摆动 速度 约 为 0. 15m/s， 支 撑 腿 速度 约 为 0. 14m/s。 在 这 些 参 数 
下 ， 平 均 机 体 速度 约 达到 0.025m/s。 控 制 器 可 以 提供 每 个 需求 的 转 矩 和 轨迹 ， 
如 图 5. 6 CHR) 所 示 。 

当 步 行 机 器 人 试图 跟随 相同 的 机 体 和 腿 部 轨迹 ， 但 是 关节 转 矩 限制 在 
35. 32N m (情况 A 的 最 大 转 矩 ) 时 ， 中 间 腿 的 电机 达到 饱和 ， 不 能 提供 所 需 
的 转 矩 ， 因 此 ， 实 际 轨 迹 与 指定 的 路 径 不 同 ,- 如 图 5. 6 中 R) 所 示 。 在 这 些 
条 件 下 ， 机 器 人 不 能 维持 规划 的 轨迹 ， 并 在 几 秒 钟 内 跌倒 〈z 分 量 王 0) ， 因 为 它 其 
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至 不 能 保持 其 几何 稳定 性 。 

因此 ， 当 转 矩 受到 限制 时 ， 机 器 人 不 能 完成 所 要 求 的 任务 。 也 就 是 说 ， 机 器 
人 不 能 通过 跟踪 定义 足 端 轨迹 来 实现 所 需 的 机 体 轨迹 。 但 是 ， 机 器 人 的 主要 任务 
是 跟随 机 体 的 轨迹 ， 这 可 以 使 用 如 图 5.4 中 的 情况 A 或 情况 B 中 指定 的 足 端 轨 
迹 。 对 于 这 些 足 端 轨 迹 ， 施 加 的 转 矩 低 于 最 大 转 矩 ， 见 表 5. 1， 对 于 情况 A， 可 
以 跟踪 机 体 轨迹 。 注 意 ， 在 情况 了 中 ， 腿 1 和 腿 3 所 需 的 腿 部 工作 空间 的 面积 与 
情况 C 相同 ; 因此 ， 在 情况 C 中 ， 限 制 腿 部 工作 空间 以 限制 不 可 行 的 足 端 轨 迹 ， 
在 情况 B 中 (对 于 腿 1 和 腿 3)， 从 而 失去 跟踪 所 需 轨 迹 的 可 能 性 。 因 此 ， 使 用 
任何 一 种 关于 转 矩 的 信息 〈 已 知 或 通过 直接 测量 )， 步 态 算法 可 以 避免 那些 机 器 
人 不 稳定 的 姿态 要 求 的 转 矩 ， 并 寻找 满足 稳定 性 的 保持 机 体 轨 迹 的 新 立足 点 ， 从 
而 提高 机 器 人 的 机 动能 力 。 


5.4 电机 转 矩 限制 对 实际 机 器 人 的 影响 


本 节 说 明 对 于 给 定 机 体 运 动 的 真实 机 器 人 ， 即 使 在 保持 相同 的 几何 稳定 裕 度 
的 情况 下 ， 静 态 稳定 性 是 如 何 降低 的 。 图 5.7 (b) 显示 了 SILO4 步行 机 器 人 
(附录 AD 在 开始 新 的 蟹 行 轨迹 时 的 姿态 。 在 这 种 姿态 下 ， 机 器 人 处 于 静态 稳定 ， 
操作 人 员 或 导航 员 可 以 决定 抬 起 机 体 ， 跟 踪 平 行 于 机 体 参 考 坐 标 系 的 = 轴 的 轨迹 
(其 中 假设 被 调 平 ) 直到 图 5.7 (a) 所 示 的 姿态 。 此 动作 不 改变 几何 静态 稳定 
性 ， 因 为 重心 和 足 接触 点 的 投影 保持 不 变 。 但 是 ， 腿 3 中 的 关节 3 Ja ERA 
b) 中 处 于 过 载 位 置 ， 腿 3 的 第 3 个 连 杆 几乎 水 平 ， 因 此 施加 在 足 3 的 力 在 关节 
3 (T;,=DF;) 产生 大 的 转 矩 ， 姿 态 所 需 的 关节 转 矩 可 能 超过 最 大 人 允许 值 ， 只 能 
舍弃 此 种 轨迹 ， 同 时 减少 机 器 人 稳定 性 (图 5. 8) 。 图 5. 8 H, Ta 是 腿 3 的 关节 
3H, FREREW A, D>d>T3>Tis. 


: 


(a) 第 1 个 初始 万 态 Cb) 第 3 个 初始 变态 
图 5.7 实验 机 器 人 第 1 和 第 3 个 初始 姿态 
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T3 =Fd 


图 5.8 施加 在 关节 3 WY Fe 


已 经 进行 了 一 些 实验 来 说 明 这 种 影响 。 它 们 是 在 拾 起 机 体 的 同时 ， 保 持 机 器 
人 在 图 5.7 所 示 的 两 个 姿态 中 具有 xz Bly 足 分 力 。 在 运动 开始 时 ， 机 体 水 平 ， 并 
且 机 体 参 考 和 坐标 系 中 的 初始 足 位 置 为 
(Bea sot ) kee; 二 (0.35m,0,. 30m) 


人 aa 9 VY foot Vi z (0. 35m, =p 35m) 
(5:132 
(Lik » VY foot ) es, 一 (一 0. 20m,0. 20m) 


Cto 1 Yio Jeg, = (—O. 15m, 一 0. 42m) 
在 第 1 个 实验 中 ， 机 体 的 高 度 约 为 0.36m [图 5.7 (a) ], B 
(Zoot ies, 一 一 0.36mj i= 1,044 (5. 14) 

机 体 以 0.01m/s 的 速度 升 高 约 0.03m。 在 实验 过 程 中 ，z 分 力 和 y 分 力 保 
持 其 值 ， 而 机 体 的 z 分 量 增加 到 最 终 的 > 值 。 图 5.9 a 所 示 为 第 1 个 实验 = 向 
足 分 力 的 变化 规律 。 腿 3 达到 了 最 终 位 置 ， 与 其 他 腿 的 轨迹 略 有 不 同 。 

第 2 个 实验 重复 了 上 述 过 程 ， 但 从 机 体 开 始 高 度 为 0. 32m， 即 所 有 腿 的 = 一 
一 0. 32m〔 比 第 1 个 实验 中 低 0.04m)。 图 5.9 b) 所 示 为 第 2 个 实验 z 向 足 分 
力 的 变化 规律 。 在 这 种 情况 下 ,， 足 1、 足 2 和 足 4 能 够 正确 移动 ; 但 是 足 3 跟踪 
轨迹 不 规则 ， 因 为 腿 3 的 关节 不 能 提供 所 需 的 转 矩 。 在 实验 结束 时 ， 腿 3 未 能 达 
到 其 最 终 位 置 ， 机 器 人 无 法 保持 水 平 ， 其 稳定 性 变 差 。 

第 3 个 实验 从 高 度 大 于 0. 27m 开始 ， 再 次 进行 相同 的 过 程 ， 如 图 5.7 b) 
所 示 。 图 5.9 (c) 显示 了 结果 。 在 这 种 情况 下 ， 腿 3 不 能 向 上 移动 机 体 (z 分 量 
保持 不 变 )， 身 体 倾斜 ， 几 何 稳定 性 降低 且 静 态 稳 定性 变 差 。 因 此 ， 适 当 的 关节 
转 矩 测量 或 估计 可 以 避免 运动 不 稳定 ， 将 该 测量 值 结 合 到 步 态 生成 算法 中 可 以 提 
高 步行 机 器 人 的 机 动 性 (5. 5.2 节 )。 
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图 5.9 3 个 不 同 实验 的 = 向 足 分 力 


总 结 3 个 实验 发 现 ， 限 制 腿 部 工作 空间 是 不 明智 的 ， 因 为 这 样 会 使 一 些 需要 
实现 的 姿态 无 法 实现 ， 降 低 机 器 人 性 能 。 此 外 ， 可 以 通过 有 效 载荷 减少 或 放大 腿 
部 工作 空间 ， 人 类 和 动物 就 是 执行 类 似 的 方式 。 因 此 ， 必 须 通过 控制 电机 转 和 矩 和 
功 耗 来 优化 步行 机 器 人 的 性 能 。 许 多 机 器 人 控制 器 和 驱动 占 可 以 测量 电机 电 枢 电 
流 。 电 机 转 矩 与 此 电流 成 比例 ， 因 此 直接 测量 电 枢 电流 可 获得 电机 转 矩 。 此 外 ， 
独立 的 电机 电流 相 加 后 可 计算 总 功 耗 。 

真正 的 步行 机 器 人 可 以 通过 改变 转 矩 和 功 耗 来 得 到 好 的 稳定 裕 度 ， 并 提高 其 
机 动 性 ， 特 别 是 在 使 用 自由 步 态 时 。 在 这 种 步 态 中 ,无 论 是 存在 操作 者 还 是 自主 
系统 中 ， 导 航 仪 可 以 随时 更 新 运动 方向 。 步 态 发 生 器 将 使 用 全 部 腿 部 工作 空间 来 
生成 足 端 轨迹 ， 而 从 转 和 矩 限制 的 观点 出 发 某 些 位置 可 能 是 不 适用 的 。 步 态 规 划 中 
考虑 转 矩 和 功 耗 则 可 以 防止 这 种 情况 。 

尝试 修改 静态 稳定 概念 只 是 初步 讨论 ， 基 于 几何 考虑 扩展 的 新 定义 还 包括 转 
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5.5 全 局 稳定 标准 
5.5.1 全 局 标准 的 定义 


要 保持 腿 部 机 器 人 的 稳定 必须 满足 以 下 条 件 : 
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(1) 必须 有 至 少 3 条 腿 支 撑 机 器 人 。 

(2) 稳定 裕 度 必须 是 正 的 。 

(3) 致 动 器 必须 施加 所 需 的 关节 转 矩 。 

用 于 度量 机 器 人 的 稳定 性 有 多 种 稳定 裕 度 ， 是 否 适 合 取决 于 工作 条 件 (第 2 
章 )。 但 所 使 用 的 裕 度 并 不 影响 最 终 稳定 性 标准 。 因 此 ， 为 了 简单 起 见 ， 选 择 了 
绝对 稳定 裕 度 (SSM). 

转 和 矩 极限 稳定 裕 度 定义 如 下 : 

定义 5.1 每 条 腿 有 3 个 关节 的 半 腿 机 器 人 转 矩 的 极限 稳定 裕 度 Stsm 是 3n 
维度 的 向 量 ， 定 义 为 A 
~~ | Treg 


(5. 15) 


Stsm = 


| 

P Tina, 一 一 由 关节 i 驱动 的 最 大 允许 转 矩 ( 正 ); 
Tre, 一 一 所 需 的 最 大 转 矩 。 

直流 电动 机 :中 的 转 矩 ce, 直接 依赖 于 其 电 枢 电流 TI;， 也 就 是 说 ,二 Kwl;， 
其 中 天 是 电动 机 的 转 矩 常数 。 因 此 ， 式 〈5. 15) 可 以 表示 为 

tan: Ru T] 


Stsm = 


(5. 16) 


Tmax = Ku, | Ta， | 


3n 


实际 系统 中 的 电机 和 致 动 器 只 能 提供 有 限 的 转 和 矩 ， 通 常 由 电机 本 身 、 驱 动 器 
和 电源 供应 饱和 度 决定 。 如 果 给 定 的 关节 需要 大 于 最 大 值 的 转 矩 ， 则 关节 只 能 施 
加 小 于 所 需 的 转 和 矩 。 在 这 种 情况 下 ， 腿 可 能 会 失效 ， 机 器 人 可 能 变 得 不 稳定 。 

机 融 人 系统 的 另 一 个 限制 是 电源 可 以 提供 的 最 大 电流 。 可 能 存在 这 样 的 腿 部 布 
局 ， 其 Stsu 不 受 限 ,但 通过 系统 的 总 电流 高 于 电源 供电 电流 。 在 这 种 情况 下 ， 一些 
关节 将 不 能 提供 所 需 的 转 矩 ， 并 且 会 出 现 不 稳定 的 情况 。 因 此 定义 以 下 稳定 裕 度 。 

定义 5. 2 电流 稳定 裕 度 Seov 是 由 电源 供应 的 当前 最 大 电流 和 所 有 电机 需求 
的 电流 之 间 的 差 值 ， 即 

Ses = Ls D>) GI _ ©.17) 
AP I 一 一 最 大 电源 电流 ; 
1 一 一 电机 i 的 当前 电流 。 

基于 上 述 前 提 ， 将 全 局 静态 稳定 裕 度 定义 如 下 : 

定义 5.3 全 局 静态 稳定 裕 度 的 向 量 定义 为 
Ssm 
Srsm 


(5. 18) 


Sossm = 


Scsm 
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部 分 “步行 测量 和 算法 


然后 静态 稳定 性 可 以 定义 如 下 : 

定义 $.4 步行 机 器 人 如 果 其 全 局 静态 稳定 ， 则 全 局 静态 稳定 裕 度 Scssu 是 
正 的 。 

请 注意 ， 为 了 应 用 这 个 稳定 性 标准 ， 必 须知 道 : 中 每 个 机 器 人 关节 所 需 施 加 
的 转 矩 ， @ 每 个 关节 可 提供 的 最 大 转 矩 (假设 对 所 有 机 器 人 的 关节 都 是 相同 的 ); 
图 瞬时 电流 ; @ 电 源 提供 的 最 大 电流 ; 加 稳定 裕 度 ， 可 以 很 容易 地 从 足 端 位 置 
计算 。 

Sess 3n +2 个 大 小 不 同 的 分 量 (3n 是 关节 数 ) ， 由 于 其 单位 不 同 很 难处 
理 。 通 过 归 一 化 Scssw 分 量 的 最 大 值 可 以 获得 无 量 纲 分 量 ， 并 可 以 表示 为 与 其 最 
大 值 的 比值 .为 此 ， 定 义 归 一 化 的 几何 稳定 裕 度 为 


S 
Som m (5. 19) 


AP 工 一 一 机 器 人 可 以 实现 的 最 大 几何 稳定 裕 度 。 

那么 ， 如 果 SswvE(0，1]， 机 器 人 静态 稳定 。 注 意 ， 四 足 机 器 人 在 被 阻挡 
的 姿态 获得 最 大 裕 度 : 中 机 器 人 不 能 抬 起 腿 ， 因 为 这 会 导致 它 失 去 其 稳定 性 ; 
@ 机 器 人 不 能 移动 机 体 ， 因 为 所 有 腿 都 已 最 大 伸展 。 而 六 足 机 器 人 不 会 被 所 有 腿 
完全 伸展 的 姿态 阻挡 ， 因 为 他 们 可 以 摆动 3 条 腿 ， 而 另外 3 条 腿 支 撑 。 

归 一 化 的 转 矩 极限 稳定 裕 度 类 似 的 定义 为 具有 通用 元 素 ; 向 向 量 ， 即 


[ee | 


Stsm,, 一 1 一 (5. 20) 
Ft. WES, (0，1]，Vi， 机 器 人 稳定 。 
最 后 ， 归 一 化 电流 稳定 裕 度 变 为 
Siki 
Scsm, = 1 — = (521) 
N a 
如 果 Sesmy E (0, Hz 机 器 人 稳定 。 
利用 这 些 标准 化 的 裕 度 ，Sessv 可 以 重 写 为 
1 
Sessmy =M i C5522) 


i (3n+2)X1 


其 中 M 称 为 静态 稳定 裕 度 ， 并 启发 了 我 们 想 将 机 器 人 在 不 稳定 状态 下 移动 
的 想法 。 只 有 当 ME (0，1) 时 静态 稳定 ， 请 注意 ，Ssw 的 M 静态 稳定 裕 度 意味 


着 裕 度 必须 大 于 ML ， 而 对 于 Srsw 和 Sem 静态 稳定 裕 度 M 表示 re MD) ILI 
i=l 
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必须 分 别 低 于 Tmax, FH Dinas Max, 和 MIss。 也 就 是 说 ， 如 果 指 定 静 态 稳 定 裕 度 
M=0.1， 这 意味 着 要 执行 步 态 从 不 稳定 值 到 稳定 安全 区 域 需 要 移动 0.1 倍 的 最 
大 稳定 裕 度 值 。 例 如 ， 如 果 最 大 几何 稳定 裕 度 为 0.25m， 每 个 关节 人 允许 的 最 大 转 


Wi zw 为 BON + m 电源 允许 的 最 大 总 电流 ST ILI 为 5A， 则 步 态 将 以 高 于 


0. 025m 的 几何 稳定 裕 度 ， 低 于 72N . m 的 关节 转 矩 和 低 于 4.5A 的 总 电流 进行 。 
在 这 种 情况 下 ， 机 器 人 即使 面 对 明 显 的 扰动 也 能 行走 。 

确定 转 和 矩 和 电流 稳定 裕 度 有 直接 测量 和 估计 两 种 方法 。 直 接 测量 关节 转 矩 相 
对 简单 ， 不 需要 在 机 器 人 上 安装 额外 的 传感器 ， 电 机 驱动 器 和 控制 器 通常 提供 与 
电机 转 矩 〈 电 流 ) 成 比例 的 模拟 信号 。 但 是 ， 这 种 方法 要 求 确 定 机 器 人 的 下 一 个 
支撑 姿态 ， 以 确定 是 否 会 保持 稳定 裕 度 ， 这 是 这 种 方法 的 一 个 显著 缺点 。 

第 二 种 方法 ， 即 基于 对 机 器 人 下 一 个 姿势 所 需 转 矩 的 先 验 估 计 效率 更 高 ， 因 
为 可 以 预先 检测 到 不 稳定 。 然 而 ， 计 算 所 需 的 转 和 矩 需 要 一 个 准确 的 机 器 人 动态 模 
型 和 力 的 分 布 。 这 是 一 个 复杂 的 问题 ， 目 前 使 用 的 优化 方法 不 具有 实时 性 
(Pfeiffer 和 Weidemann, 1991; Lin 和 Song，1993) 。 另 一 个 缺点 是 这 个 算法 将 
依赖 于 机 器 人 上 的 载荷 ， 必 须 由 控制 器 发 送 或 机 器 人 自身 测量 ， 因 此 需要 一 个 额 
外 的 传感器 。 

通过 测量 或 估计 获得 全 局 稳定 裕 度 可 以 改善 机 器 人 的 步 态 。 自 由 步 态 的 特点 
是 立足 点 和 腿 部 序列 选择 基于 诸如 稳定 性 测量 、 地 形 条 件 和 运动 方向 等 (第 4 
章 ) 。 关 节 转 矩 和 功 耗 是 立足 点 选择 算法 的 两 个 新 条 件 /限制 。 如 果 估 计 稳 定 裕 
度 ， 那 么 可 以 在 立足 点 选择 中 处 理 ， 这 当然 是 最 好 的 解决 方案 。 但 是 ， 如 果 稳 定 
裕 度 是 通过 直接 测量 获得 的 ， 机 器 人 必须 超出 稳定 裕 度 的 姿势 注意， 这 并 不 意 
味 着 机 器 人 将 变 得 不 稳定 ) 。 这 种 情况 下 的 解决 方案 是 重新 计算 立足 点 ， 检 测 不 
稳定 的 边际 。 通 常 ， 机 器 人 会 停止 ， 有 些 轨迹 特征 可 能 改变 ， 如 速度 ， 但 这 种 方 
法 实时 实现 是 最 简单 的 。 | 

本 章 介 绍 的 包含 于 步 态 生 成 中 的 稳定 性 标准 算法 很 简单 ， 直 线 迈 步 在 下 面部 


5.5.2 基于 全 局 标准 的 步 态 


为 了 说 明 如 何在 步 态 算 法 中 使 用 全 局 稳定 裕 度 ， 此 处 考虑 第 4 章 开 发 的 不 连 
续 自 由 步 态 。 在 该 算法 中 ， 立 足 点 规划 有 1 一 E5 5 个 限制 。 现 在 ， 必 须 施 加 两 
个 附加 限制 E6 和 E7。 

约束 E6: 立足 点 必须 达到 转 矩 极限 稳定 条 件 ， 写 为 

O GLT M, Vi€E[l,3n] (5. 23) 


AP 4 > 
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MM 一 一 期 望 的 运动 的 准 静 态 稳定 裕 度 定义 。 
约束 E7: 立足 点 必须 达到 总 电流 约束 的 条 件 ， 写 为 


i=3n 


Dd 


MRAR EL~ES 不 满足 (图 5.10)， 算 法 就 重复 开始 选择 下 一 条 腿 (按照 
在 第 4 章 定义 的 标准 序列 N 或 K) 。 如 果 机 器 人 控制 器 可 以 估计 关节 转 矩 和 总 电 


二 人 (5. 24) 


腿 序列 管理 器 立足 点 规划 器 


FH 是 否 满足 限制 
E1~E5? 


-关节 转 矩 


-电机 电流 
(E6 十 E7) 


FH 是 否 满足 限制 
E6—E7? 


图 5.10 自由 步 态 算法 ， 包 括 关节 转 矩 和 电动 机 电流 标准 
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第 5 章 新 的 稳定 性 方 ; 


流 (情况 A) HAR E6 和 E7 满足 ， 将 腿 放置 在 选 定 的 立足 点 。 如 果 机 器 人 控 
制 器 不 能 估计 关节 转 矩 和 总 电流 ， 但 可 以 测量 实际 值 ， 则 在 足 部 放置 期 间 检查 约 
束 E6 和 E7 [图 5. 10 情况 (B)]。 如 果 违 反 所 选 的 全 局 裕 度 (约束 E6 和 E7), 
则 腿 部 LT HRE, SOR MMAR. 

腿 部 序列 管理 、 机 体 运 动 规划 和 腿 部 抬升 规划 算法 与 第 4 章 保持 一 致 。 


5.6 结论 


传统 上 步行 机 器 人 的 静态 稳定 性 测量 集中 在 几何 方面 。 本 章 阐明 ,单独 考虑 
几何 参数 稳定 将 导致 机 器 人 设计 无 效 和 故障 。 通 过 计算 机 模拟 和 使 用 真正 的 步行 
机 器 人 实验 能 够 反映 出 有 限 测量 的 效果 。 本 章 陈述 了 这 些 问 题 ， 并 通过 在 步 态 算 
法 设计 中 考虑 关节 转 矩 和 能 耗 来 克服 。 还 提出 了 一 个 全 新 的 全 局 稳定 性 标准 ， 将 
这 些 新 的 因素 归纳 到 步行 机 器 人 静态 稳定 裕 度 ， 考 虑 几何 和 转 矩 /功率 测量 。 全 
局 稳定 标准 是 基于 几何 稳定 裕 度 (标量 ) 以 及 转 矩 极限 稳定 裕 度 〈 矢 量 ) 和 电流 
稳定 裕 度 〈 标 量 ) 两 个 新 标准 。 本 章 指出 通过 在 机 器 人 和 运动 步 态 设计 中 考虑 全 
局 静态 稳定 ， 可 以 改进 步行 机 器 人 的 特征 和 功能 。 


W 


te 
控制 技术 


步行 机 器 人 是 非常 复杂 的 机 械 系统 ， 是 具有 一 定 自 由 度 (DOF) 的 可 变 结 
构 。 为 了 设计 控制 步行 机 器 人 的 算法 ， 获 得 能 准确 描述 机 器 人 的 运动 学 和 动力 学 
行为 的 模型 很 重要 。 

运动 学 模型 描述 了 关节 变量 、 足 端 位 置 及 其 速度 之 间 的 关系 ， 而 动力 学 模型 
则 描述 与 关节 运动 有 关 的 力 。 

步行 机 器 人 的 运动 学 可 以 简化 为 其 腿 和 机 体 的 运动 学 。 传 统 的 多 足 式 机 器 人 
腿 部 最 多 表现 为 3 自由 度 ，3 自由 度 以 上 的 足 式 机 器 人 并 不 常见 。 这 本 书 中 不 包 
括 双 足 和 人 型 机 器 人 。 

关于 机 体 的 运动 学 ， 可 以 简化 为 机 体 在 空间 中 的 方位 ， 通常 通过 使 用 双 轴 倾 
斜 仪 和 电磁 罗盘 来 测量 。 众 所 周知 ， 如 果 已 知 机 器 人 的 支撑 平面 ， 腿 部 运动 学 可 
以 确定 机 体 的 位 置 和 方向 。 在 不 规则 的 非 结 构 化 地 形 上 ， 只 能 通过 传感器 直接 获 
得 机 体 方向 。 

腿 的 运动 学 等 同 于 机 械 手 的 运动 学 ， 因 此 ， 生 成 运动 学 关系 的 方法 也 是 一 样 
的 。 其 中 一 种 方法 是 利用 三 角 关 系 。 但 这 会 导致 运动 学 分 析 非 常 复杂 ， 一 些 约定 
的 引入 大 大 简化 了 最 终 方程 。 最 受 欢迎 的 方法 是 由 Denavit 和 Hartenberg® 在 
1955 年 定义 的 CD- 五 方法 ) ， 即 选择 与 关节 和 连 杆 相关 联 的 参考 坐标 系 ， 导 出 
开 链 机 构 的 运动 学 模型 。 这 种 方法 特别 适用 于 DOF 数量 很 多 的 情况 。 对 于 3 A 
由 度 机 构 ， 运 动 学 模型 可 以 通过 三 角 关 系 轻松 推导 出 来 。 然 而 ， 根据 D - H 方法 
指定 的 运动 学 模型 也 有 助 于 推导 出 动力 学 模型 。 

导出 开 链 关节 机 构 的 运动 学 模型 的 D-H 方法 可 以 在 《Robot Manipulators) 
的 书籍 中 找到 (Fu 等 ，1987; Paul, 1981; Spong 和 Vidyasagar, 1989; Craig, 
1989)。 本 章 将 提 到 D-H 方法 的 基本 步骤 ， 有 兴趣 的 读者 还 可 阅读 参考 书 。 

相 比 之 下 ， 获 得 四 足 运动 学 方程 是 极其 耗 时 的 ， 且 会 产生 一 个 不 定 方 程 组 ， 
因此 必须 使 用 优化 准则 来 解决 ， 例 如 最 佳 力 分 布 或 采用 拉 格 朗 日 乘 数 法 ( Benna- 


© 这 里 将 Denavit - Hartenberg 转换 称 为 D-H HM. 


121 


ni 和 Giri, 1996; Pfeiffer 和 Weidemann，1991)。 为 了 简化 问题 ， 四 足 的 动力 学 
模型 必须 基于 一 些 假设 ， 如 通常 不 考虑 腿 的 动力 学 ， 假 定理 想 传动 和 无 质量 腿 。 
但 是 假设 应 该 考虑 机 器 人 的 动态 特征 ， 以 避免 不 合理 的 简化 造成 的 错误 。 为 了 使 
动力 学 方程 式 准确 反映 现实 物理 系统 ， 关 键 是 对 系统 有 显著 影响 的 因素 的 建 模 。 
必须 在 准确 模型 及 其 动态 控制 实时 性 之 间 折 中 。 因 此 ， 机 器 人 动力 学 分 析 方 法 多 
许 简 化 运动 方程 而 在 实时 控制 中 不 产生 明显 错误 。 由 于 运动 学 方程 用 于 轨迹 生成 
和 控制 ， 其 应 反映 机 器 人 在 不 同 的 运动 状态 时 出 现 的 动态 效应 。 

通过 机 器 人 动力 学 实验 可 以 修正 动力 学 模型 (Armstrong, 1989; Mayeda 
等 ，1984; Swevers 等 ，2000) 。 基 于 动态 响应 中 的 初始 猜测 值 ， 通 过 实验 参数 
识别 来 获得 运动 学 方程 。 然 而 ， 初 始 猜测 值 的 正确 性 至 关 重 要 ， 而 这 些 方法 并 没 
有 给 出 对 机 器 人 动力 学 概念 和 物理 理解 的 任何 深入 研究 。Garcia 等 人 (2003) 提 
出 了 一 种 实验 方法 ， 根 据 轨 迹 参 数 对 步行 机 器 人 进行 动态 分 析 。 这 种 方法 可 用 于 
基于 机 器 人 模型 的 控制 ， 例 如 计算 转 矩 控制 。 控 制 精度 高 度 依赖 于 模型 准确 预测 
所 需 的 致 动 器 的 转 矩 。 因 此 ， 该 方法 需要 确定 在 不 同 的 腿 部 轨迹 情况 下 ， 影 响 系 
统 轨迹 的 主要 动力 学 因素 ， 包 括 致 动 器 的 动力 和 摩擦 力 。 这 样 获 得 的 数学 模型 可 
以 获得 系统 动力 学 的 精确 简化 表示 。 

本 章 6.2 节 和 6. 3 节 给 出 四 足 机 器 人 的 运动 学 和 动力 学 模型 。6. 4 节 给 出 一 
个 作为 参数 轨迹 函数 的 模型 分 析 方 法 。6. 5 节 将 这 种 方法 应 用 于 SILO4 四 足 机 器 
A, 6.6 节 得 出 有 关 结 论 。 


6.2 步行 机 器 人 的 运动 学 


运动 学 模型 描述 了 腿 部 关节 变量 (gq,…,g,) ”和 足 的 位 置 和 方向 (z,y,z,7， 
poy) 之 间 的 关系 。 在 旋转 关节 的 情况 下 ， 关 节 变 量 是 与 其 相连 连 杆 的 角度 。 在 
滑动 副 或 滑动 关节 的 情况 下 ， 关 节 变 量 是 杆 件 的 伸 长 量 。 

开 链 杆 系 的 运动 学 模型 可 以 分 为 正 向 运动 学 问题 和 逆向 运动 学 问题 两 个 问 
题 。 正 向 运动 学 问题 通过 关节 变量 (gq; ,…,g,) 获得 足 的 位 置 和 方向 (zy,zyr， 
p,y)"。 相 反 ， 首 向 运动 学 问题 根据 是 的 位 置 和 方向 给 出 关节 变量 。 

6.2.1 正 向 运动 学 :“D- 于 约定 ” 

本 节 通 过 使 用 D- H 约定 导出 正 向 运动 学 模型 。 事 实 上 ,这 是 对 Spong 和 
Vidyasagar 人 研究 的 描述 (1989)。 

假设 一 个 2- DOF WHR. W: 

(1) BA n XT., 

(2) BERA n+1 个 连 杆 ， 从 0 D 到 ”( 足 ) 。 
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(3) 第 i 个 关节 连接 连 杆 i 一 1 MEF i. 

(4) 第 i 个 关节 的 关节 变量 由 gq; 表示 。 对 于 旋转 关节 是 连 杆 i 一 1 MEF i 
之 间 的 角度 。 对 于 滑动 关节 是 连 杆 i 一 1 和 连 杆 i 之 间 的 位 移 。 

(5) 每 个 连 杆 i 刚刚 附加 了 一 个 与 i 一 1 固 结 的 参考 坐标 系 i BERT 
定 在 惯性 坐标 系 0。 

有 了 上 述 假设 , DALA p: 的 坐标 ， 连 杆 i 相对 于 参考 坐标 系 i 是 恒定 的 ,不 
取决 于 腿 部 运动 。 然 而 ， 如 果 在 连 杆 i 和 i 一 1 之 间 发 生 旋转 ， 点 p; 在 参考 坐标 
系 i 一 1 中 表示 为 

pi-i1=" R;p: CE. 1) 

FOP UR, 是 旋转 矩阵 (3X3)， 表 示 第 i 一 1 参考 坐标 系 中 的 i 点 到 第 i 一 1 
参考 坐标 系 中 旋转 变换 ， 这 两 个 坐标 系 的 原点 是 重合 的 。 

在 更 一 般 的 情况 下 ， 如 果 在 两 个 参考 坐标 系 之 间 有 旋转 和 平移 ， 则 式 (6. 1) 
ZH (图 6. 1) 

pais Rip. ta, (6. 2) 


图 6.1 两 个 坐标 系 之 间 的 旋转 和 平移 


Hp pd, 是 (3X1) 向 量 ， 表 示 参 考 坐 标 系 ; 与 参考 坐标 系 i 一 1 的 原点 的 
RE., R (6. 2) 可 以 表示 为 矩阵 


Pi-1 TR; Td; Pi 
= (6. 3) 
1 Oax 1 1 


和 矩阵 


role lq 
nas i | (6. 4) 
Oux:3) 1 


称 为 齐 次 矩阵 。 具 有 形式 psp D RAF eet EES A 将 1 
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个 点 的 坐标 转换 从 参考 坐标 系 i 转换 到 参考 坐标 系 i 一 1。 这 个 矩阵 随 着 腿 的 布局 
而 改变 ， 它 只 取决 于 关节 变量 q, BI 
IIA SIAC) (6:5) 
关节 :的 齐 次 变换 矩阵 最 通用 的 公式 ， 可 以 通过 下 式 表 达 (Fu %, 1987; 
Paul, 1981; Spong 和 Vidyasagar, 1989; Craig, 1989) 


cos; —cosa;sind; sina;sin@; a;cos6; 
= sinf;  cose;cosů; | —sina;cos6; a;sind; 
TA; = | (6.6) 
0 sina; cosa; d; 
0 0 0 1 


Ha. a. 6, 和 d; 是 连 杆 参数 。 参数 a; Ma, 对 每 一 个 连 杆 都 是 常数 ，0 
是 旋转 关节 的 关节 变量 ，w& 是 用 于 滑动 副 或 滑动 关节 的 关节 变量 ,否则 它们 也 
是 常数 。 这 些 关节 参 数 定义 见 后 文 。 

最 后 ， 从 参考 坐标 系 n Œ) 到 参考 坐标 系 0 MRT) 点 坐标 转换 的 齐 次 
矩阵 为 

"A, Ay he CA, (6.7) 

1.D-H #F 

D=-H 程 序 可 以 按照 以 下 步骤 说 明 。 

d) 步骤 1: 沿 着 关节 轴 ， 找 到 关节 轴 zo s zaio 

1) 如 果 关 节 i 是 旋转 关节 ， 则 z 位 于 关节 旋转 轴 上 。 

2) 如 果 关 节 AMHR, We 位 于 关节 平移 轴 上 。 

(2) 步骤 2; 设置 髋 部 参考 系 。 在 z 的 任意 位 置 找 到 原点 轴 ， 通 过 右手 法 
则 选择 xo 和 Jo iH 

(3) 步骤 3: H i=l, 2, =, 7 一 1 执行 步骤 4 一 6。 

(4) 第 4 步 : 找 出 原点 o;。 

1) WER z 与 zx 一 相交 ， 则 定位 o 在 轴 交 叉 点 。 

2) 如 果 z FIF zis MERI i 十 1 处 定位 oi。 

D 如 果 z 和 xz;_i 不 在 同一 个 平面 ， 则 定位 o 在 与 z; 和 xz;_1 正 交 交 点 z 处 。 

(5) 步骤 5: 找到 x, 轴 。 

1) 如 果 z 与 zx :相交 ， 则 按照 正 交 于 一 = :的 方向 定位 x; 平面 。 

2) WÈ z 与 z;_ 1 不 相交 ， 则 沿 着 通过 o 正 交 于 z; Me zi。 

(6) 步骤 6 : 按 右手 法 则 定义 Vio 

(7) 步骤 7: 建立 足 部 参照 系 (tr yno 2a) 

1) 2, RA z,- JEM. 

2) x, 必须 与 zaif z, IER (x, 与 zw 相交 )。 

3) 必须 按 右手 法 则 定位 。 
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第 6 章 ”运动 学 


(8) 步骤 8: 获取 每 个 连 杆 i 的 参数 a;、a;、0, Mdo 

1) a, EWE x; Mo; Br; 和 xz;_1 的 交点 的 连 杆 的 长 度 或 距离 。 

2) a; 是 z;_1 必 须 围绕 xz; 旋转 到 与 z; 重合 的 连 杆 的 旋转 角度 。 

3) d; 是 相 邻 连 杆 之 间 的 距离 或 者 沿 着 z;_1 从 o;_1 到 xz; 和 > 的 交点 的 距离 。 
对 于 滑动 关节 ，d; 为 关节 变量 。 

4) 0 是 相 邻 连 杆 之 间 的 角度 或 x;_| 必须 绕 z;_1 旋 转 到 与 x; 重合 的 角度 。 对 
于 旋转 关节 ，0; 为 关节 变量 。 

(9) RRO: 形成 ;1，…，7 WETA. 

(10) 步骤 10: 形成 齐 次 和 矩阵 


TR wer Be 
°A, 5A A a| | (6. 8) 
Oax» 1 
Hp pE d 给 出 髋 部 参考 系 ，“'R; 给 出 足 参 考 坐 标 系 在 髋 部 参考 坐标 系 


中 的 方位 。 

2. 正 向 运动 学 举例 

ART HES Ab AT BLA A SILO4 腿 的 正 向 运动 学 解 ， 用 作 在 本 书 中 模拟 和 实验 
的 测试 模型 。 这 条 腿 由 3 个 旋转 关节 组 成 ， 如 图 6. 2 所 示 。 


图 6.2 SILO4 腿 的 D-H 参数 
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应 用 上 述 D-H 程序 的 步骤 (1) ~ (7)， 生 成 图 6. 2 中 绘制 的 参考 系 。 步 
OR (8) 定义 的 连 杆 见 表 6. 1， 关 节 变 量 9, 、9, 和 0, 如 图 6. 2 所 示 。 


表 6.1 SILO4 腿 的 D-H 参数 


对 于 获得 的 连 杆 参数 ， 式 (6. 6) 定义 了 与 关节 相关 联 的 齐 次 矩阵 。 这 些 甜 
阵 为 


Gy 0 Sı aC, 
Si 0 = äis 
°A = (6. 9) 
© 1 0 0 
0 0 0 
Gz —S, 0 CC 
S, e 0 azS2 
2 4， 一 (6. 10) 
0 0 1 0 
0 0 0 1 
Cs = S34 0 a3C3 
S C 0 aS 
| 全 (6.11) 
0 0 1 0 
0 0 0 1 


最 后 ， 步 又 (10) EE TH ERS eG by KH HE He Bl HED SH Mb hy KH BY FL 
阵 ， 即 
amaata g “|= 
big. 2 
CiCs —SaC Si C,(a;Ca+a,C,+a1) 
SiCs —SrsS: —C, SılasCa +a:C: +a) 


(6. 12) 
S23 Cr; 0 43523 十 az S? 
0 0 0 1 
其 中 d=(2z.y.z)'. Alt. EWEX 
=C la Ca +azC; +a,) (6. 13) 
y=S, (a3 C23 十 azCz 十 al) (6. 14) 
z=a; Sz, +a2 S2 (6: 15) 


6.2.2 道 向 运动 学 


逆向 运动 学 即 通过 足 位 置 和 方向 确定 关节 变量 (gq; ，,…,g,)"。 对 于 3- DOF 
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=A, (qi) Az (qz)243: (as ) (6. 16) 


8 
N 
N 
8 
N 
N 
Do p 

一 N R R 


0 0 0 

其 中 (t y»z)" 是 足 的 位 置 ， (airsan 9431)". Caiz raz sazz)" 和 Caiz sazz» 
azn) 是 足 的 方向 向 量 。 式 (6. 16) 表示 3 个 未 知 数 的 12 个 方程 的 系统 ， 难 以 直 
接 以 封闭 的 形式 求解 ， 当 正 向 运动 学 具有 唯一 解 时 ， 逆 向 和 运动 学 问题 可 能 有 或 者 
没有 解 。 此 外 ， 如 果 存 在 解 ， 也 可 能 不 是 唯一 的 。 

封闭 形式 的 解 与 数值 解 相 比 有 两 个 优点 : 可 以 更 快 地 计算 ; @ 更 容易 在 几 
种 可 能 的 解 中 选择 一 个 特定 的 解 。 解 决 开 链 杆 系 的 逆向 运动 学 有 几何 法 、 代 数 
法 、 首 变换 法 等 。 下 面 通过 代数 法 解决 SILO4 腿 的 逆向 运动 学 。 

x (6.13) 一 式 (6.15) 涉及 足 的 位 置 和 关节 变量 。 从 式 (6.13) AX 
(6. 14) 可 得 


XS1—yCi=0 (6. 17) 
即 
= 
tanO ee (6. 18) 
At, M3270 A yO, WO 的 解 为 
6, =arctan[2(y,x) | (6. 19) 


如 果 z=0 A y=0, WO 会 出 现 无 数 解 。 在 这 种 情况 下 ， 则 说 腿 是 奇异 
姿态 。 
三 角 关 系 式 为 
$i+C=1 (6. 20) 
WAX (6.13). KR (6.14) 和 三 角 关 系 可 得 
CT 二 一 


Ca (6. 20) 
a3 
MÈ (6.15) 可 得 
Ss (6. 22) 
a3 
将 Co; 和 So ARA (6. 20) 得 
AS,+BC,=D (6. 23) 


其 中 
A=—z 
B=a,—(2C,+yS,) 


_ 2a, (xC, + yS; +a =a; =ar —2z*—(2C, 十 ySi ys 
2a: 


(6. 24) 
D 
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变换 式 (6.23) 的 等 式 变量 形式 (Craig, 1989), $ 


A=rcos$ 
(6. 25) 
Pes 
则 
$=arctan2(B,A) 
(6. 26) 
y=+ JF 
式 (6.23) 可 以 写成 
cosgsing， 十 singcosb, 一 过 (6. 27) 
或 者 
sin($ +0.) =2 (6. 28) 
利用 式 (6.20), ， 可 得 
a 2 
welt ep aT -= (6. 29) 
因此 
= (6. 30) 
+ IY — D? 
所 以 
6, =—¢+arctan[2(D,+ /y’ —D*) ] (6. 31) 
并 用 式 (6.26) 中 定义 的 $$ 和 vr 值 代入 ， 可 得 
0, = —arctan[2(B,A) ]+arctan[2(D,+ /A’?+B’—D?’) ] (6. 32) 
请 注意 式 (6. 32) 有 两 个 解 ， 必 须 通过 机 械 约束 获得 正确 的 解 。 
最 后 ，0 可 以 从 式 (6.21) 和 式 (6.22) 得 到 
0; =arctan[2(z—a, S: +t) 了 Si 0 Qi ) =). | (6. 33) 
因此 , È (6.19), XÈ (6.32) MÈ (6.33) 提供 了 SILO4 腿 型 的 反 向 运动 


学 解 。 
6. 2.3 运动 学 求解 的 几何 方法 


如 上 所 述 ，D 一 H 约定 只 是 一 种 运动 学 求解 的 系统 方法 。 但 是 ， 对 于 自由 度 
较 少 的 腿 或 者 操作 臂 ， 可 以 直接 使 用 传统 的 几何 方法 。 本 节 使 用 比例 缩放 机 构 说 
明了 这 种 方法 ， 并 提供 了 比例 机 构 的 运动 学 关系 ， 该 机 构 是 一 种 广泛 用 于 步行 机 


器 人 腿 部 结构 的 装置 〈 图 1.5 和 图 1.8)。 


比例 机 构 是 具有 4 个 被 动 关节 C) 的 四 杆 机构 ， 如 图 6.3 所 示 。 点 A 通 
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过 使 用 滑动 副 沿 > 轴 移 动 , 点 B 通过 使 用 男 一 个 滑动 副 沿 xz 轴 移 动 。 点 A 和 点 
B 运动 使 点 C 运动 。 当 其 用 作 腿 部 机 构 时 ,与 足 端 连接 。 这 个 机 构 也 称 为 平面 
缩放 仪 ， 并 提供 2 个 自由 度 。 有 两 种 方式 提供 第 3 个 自由 度 。 一 是 最 广泛 使 用 的 
比例 机 构 ， 旋 转 关 节 的 轴 与 z。 轴 重合 。 以 这 种 方式 ， 比 例 该 机 构 围 绕 x, He 
转 。ASYV 使 用 这 种 机 构 ，z 轴 平 行 于 机 体 纵 轴 (图 1.4)。 二 是 在 B 点 再 提供 一 
个 滑动 副 装 置 ， 使 点 B FITT y 轴 (垂直 于 缩放 机 构 所 在 平面 )。 这 种 机 制 称 为 
笛 卡 儿 比 例 缩 放 机 构 ， 可 提供 3 种 相互 独立 的 线性 运动 (图 1. 5 和 图 1. 8)。 


Glz, zo)" 
图 6.3 平面 比例 缩放 机 构 
从 图 6. 3 可 以 计算 足 分 量 z 为 
世 一 LicCosa 十 seoap (6. 34) 
se (6. 35) 
a, 
因此 
x=L, eR secs NS oe | [t Laas jcosg . (6. 36) 
ay ay a, 
如 果 4 个 主 杆 满足 
Li L,=L 
| (6. 37) 
wy =u, mg 
式 (6.36) 增益 率 为 
=a, (6. 38) 
a 
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从 图 6. 3 Ay Al, 足 分 量 Zo 为 @ 


zo =L,sina+d.)— Lz sing l (6. 39) 
ing eae (6. 40) 
a) 
因此 
w= (1-2 Jd + (PaL: Jsing (6. 41) 
al al 
对 于 式 (6. 37) 的 条 件 ， 可 得 
n= (1-4 Jau (6. 42) 


式 (6.38) 和 式 (6.42) 给 出 了 比例 缩放 机 构 平面 的 运动 学 关系 ， 对 于 笛 卡 
儿 比 例 缩放 机 构 ，y 分 量 由 一 个 滑动 副 驱 动 。 在 这 种 情况 下 ， 致 动 器 移动 点 B 
(被 动 关 节 ) 平行 于 HH Bit zx 分 量 是 什么 ) 。 图 6.4 显示 了 笛 卡 儿 缩 放 机 构 
的 顶 视图 。 


Clzos, yo)" 


6.4 笛 卡 儿 比 例 缩放 机 构 顶 视图 


由 图 6. 4 可 知 


siny 一 2 (6. 43) 


x 


O 注意 ，zo 分 量 被 称 为 固定 坐标 系 ， 其 中 工分 量 被 称 为 参考 坐标 系 (z，z)， 其 位 于 缩放 机 构 所 在 
的 平面 上 。 
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用 式 (6.38) 可 得 
Mi = (6. 45) 


足 端 变量 为 ETETE TA 关节 变量 为 Cdosd ER ae 式 (6. 38) 给 出 了 
平面 缩放 机 构 平 面 中 包含 的 系统 的 x 分量 az), Hd, 是 关节 变量 。zo 作 
为 do 的 函数 ， 有 


x) =xcosy=~d , cosy - (6. 46) 
从 图 6. 4 可 得 
d,= Jd» dy (6. 47) 
ee See (6. 48) 
Jda tdy i 
则 
a= ds (6. 49) 
a 
式 (6.49), sR (6.45) 和 式 (6.42) 可 以 以 矩阵 形式 写成 
E 0 0 
Xo ie dzo 
G 
Ve 7T 0 a 0 dy (6. 50) 
之 0 dn 
0 0 i 一 七 


因此 ， 第 卡 儿 缩放 机 构 的 分 量 是 解 厢 的 ， 每 个 外 部 分 量 只 取决 于 其 内 部 分 
E., 这 是 比例 缩放 机 构 的 优点 之 一 。 另 一 个 优点 是 足 分 量 运 动 是 其 关节 的 do 或 
dy FEVA xo Al yo 分 量 的 因子 L/a，dw 乘 以 z 分 量 的 因子 (1 一 L/a)。 

当 分 量 解 耦 时 ， 可 以 容易 地 计算 模型 的 逆向 运动 学 关系 ， 即 


A 0 0 
da Xo 
da= 0 F Oo ja (6.51) 
dn a Zo 

nae oa 


有 兴趣 的 读者 可 以 尝试 计算 第 3 个 自由 度 为 旋转 关节 的 比例 缩放 机 构 的 运动 
学 关系 。 
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6.3 步行 机 器 人 的 动力 学 


机 器 人 动力 学 描述 了 机 器 人 运动 与 相应 的 力 之 间 的 关系 ， 上 有 具体 来 说 ， 推 导 以 
下 机 械 臂 动力 学 模型 的 数学 关系 : 

(1) 机 器 人 人 位置、 速度 和 加 速度 。 

(2) 在 机 器 人 关节 或 末端 致 动 器 上 施加 的 力 和 转 和 矩 。 

(3) 机 器 人 操作 臂 的 尺寸 参数 ， 如 连 杆 长 度 、 质 量 和 惯性 。 

步行 机 器 人 是 非常 复杂 的 机 械 系 统 。 步 行 机 器 人 的 腿 通 过 机 体 连 接 ， 并 接触 
地 面 ， 形 成 封闭 的 运动 链 。 力 和 运动 通过 运动 链 从 一 条 腿 传递 到 另 一 条 腿 ， 因 此 
存在 动态 耦合 。 对 于 有 和 条 腿 ， 每 条 腿 及 个 DOF 的 复杂 系统 的 运动 方程 ， 采 
用 d'Alembert 的 原则 推导 ， 即 

Ji, t—JEF =D(q)q +H(q.q)+C(q) (6. 52) 

其 中 ，rER”， 为 主动 关节 转 抢 矢量 ; FER”, Ame hy Kim; DE 
有 Rs， 为 惯量 和 矩阵，qgER”  ， 为 广义 坐标 的 矢量 ;， 互 ER”… ， 为 科 氏 力 
和 离心 力 效 应 ; CER”, AT MHBA; Ju ER™™t, Je ER’, 分别 映 
射 转 矩 和 接触 力 到 广义 坐标 q。 

计算 上 述 运 动 方程 非常 耗 时 ， 将 产生 nm 十 6 个 方程 ，2nm 个 未 知 变量 (zt 和 
F)， 必 须 使 用 一 些 优 化 准则 来 解决 。 例 如 最 佳 力 分 布 和 拉 格 朗 日 乘 数 法 (Ben- 
nani 和 Giri，1996; Pfeiffer 和 Weidemann，1991) 。 为 了 简化 问题 ， 通 常 假 设 是 
基于 高 传动 比 机 器 人 系统 腿 的 属性 。 使 用 大 传动 比 的 关节 的 腿 可 以 忽略 Coriolis 
和 离心 力 的 耦合 作用 ， 从 而 得 到 解 耦 的 动态 方程 式 (6. 52)。 但 大 传动 比 还 具有 
其 他 动力 学 特性 ， 如 摩擦 、 反 向 间隙 和 弹性 (Garcia 等 ，2002; Pfeiffer 和 
Rossmann, 2000; Shing, 1994; Spong，1987) 。 因 此 如 果 在 机 器 人 关节 中 使 用 
大 传动 比 ， 动 态 方程 可 以 解 耦 ， 但 其 他 动态 效应 必须 建 模 。 

从 动力 学 角度 可 以 将 机 器 人 的 腿 作为 3 自由 度 操 纵 臂 进行 研究 ， 足 作为 终端 
致 动 器 。 操 纵 臂 的 动力 学 由 机 械 部 件 、 致 动 器 、 传 动 系统 组 成 。 机 械 部 件 的 动态 
模型 表明 操纵 臂 运动 与 力 、 力 和 矩 之 间 的 数学 关系 。 致 动 器 和 传动 系统 的 动态 模型 
决定 控制 信号 和 力 、 力 矩 之 间 的 关系 。 下 文 将 介绍 步行 机 器 人 的 致 动 器 和 腿 的 机 
械 部 分 的 动力 学 模型 。 


6.3.1 机 械 系 统 的 动力 学 模型 


3 自由 度 腿 的 机 械 部 分 是 由 腿 的 连 杆 构成 的 链 ， 不 包括 致 动 器 和 传动 系统 。 
用 拉 格 朗 日 方程 可 得 出 腿 的 机 械 部 分 的 动力 学 方程 (Fu 等 ，1987)。 直 接应 用 拉 
格 朗 日 动态 方程 与 D-H 连 杆 坐标 表示 呈现 出 简洁 、 紧 凑 、 系 统 的 腿 运 动 方程 是 
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紧凑 的 运动 方程 。 虽 然 在 开 环 控制 中 实时 计算 牛顿 一 欧 拉 公 式 (Fu 等 ，1987) 
比 拉 格 朗 日 方程 有 效 ， 但 是 现在 的 处 理 器 足以 快速 计算 4X4 拉 格 朗 日 公式 的 齐 
次 变换 矩阵 。 拉 格 朗 日 公式 是 一 种 用 于 导出 数学 表达 式 的 简单 、 安 全 的 方法 。 其 
后 对 腿 的 动力 学 模型 进行 简化 分 析 ， 以 确保 最 终 运 动 方程 的 实时 计算 。 

用 拉 格 朗 日 方程 系统 推导 出 一 个 动力 学 表达 式 如 下 

t.—J'F=D(g)g +H(q.q)+C(q) (6. 53) 
wP Da) 一 一 腿 的 3X3 质量 和 矩阵; 
五 一 一 离心 力 和 科 氏 力 的 3X1 RE; 

Ca) 一 一 重力 项 的 3X1 矢量。 

质量 和 矩阵 是 对 称 正 定 和 矩阵 ， 与 腿 的 配置 相关 。 其 对 角 元 素 4d; 是 当 所 有 其 余 
的 关节 被 禁止 时 机 械 部 件 对 关节 : 的 惯性 矩 di 元 素 代 表 关 节 7 的 加 速度 对 关节 
i 的 影响 。 

离心 力 和 科 氏 力 依赖 于 姿态 和 速率 。h, 元 素 是 关节 速度 二 次 项 的 总 和 ， 代 
表 其 余 关节 的 速度 对 关节 i 造成 的 影响 。 重 力 项 的 矢量 与 姿态 有 关 。c; 项 表示 由 
重力 引起 的 绕 关节 ; 旋转 的 力矩。 

式 (6.53) 的 第 一 项 包括 跟踪 轨迹 所 需 的 转 矩 和 力 ， 其 中 是 主动 关节 转 
和 矩 的 3X1 矢量 , 下 是 3X1 地 面 接触 力 矢量 。 在 腿 的 摆动 相 ， 没 有 是 与 地 形 相互 
EH, FF 变 为 零 。 但 是 ,在 支撑 相 足 接地 ， 因 此 式 (6.53) 变 为 不 定 方程 。 通 过 
下 列 方式 之 一 解决 足 地 接触 ， 使 式 (6. 53) 变 为 不 定 方程 。 

(1) 使 用 拉 格 朗 日 乘 数 使 能 量 也 数 最 小 化 (Dettman, 1988). 

(2) 建立 足 与 地 形 的 相互 作用 (Manko, 1992) 模型 ， 建 立 接触 力 和 足 的 位 
置 之 间 的 关系 ， 增 加 所 需 解决 的 方程 数 [ 式 (6.53) ]. 

(3) 在 足 端 使 用 力 传感器 来 测量 (Zhou 等 ，2000) 。 


6.3.2 致 动 器 和 传动 系统 的 动力 学 模型 


致 动 器 和 传动 系统 在 机 器 人 动力 学 计算 中 是 相关 的 。 执 行 机 构 主 要 有 电动 、 
气动 和 液压 3 种 类 型 。 由 于 电 驱 动 可 以 更 精确 地 控制 ， 因 此 被 广泛 使 用 。 使 用 电 
驱动 在 直流 电动 机 的 运行 中 ,转子 旋转 期 间 产生 惯性 力 和 摩擦 力 ， 必 须 通 过 电机 
转 矩 进行 平衡 。 如 果 步 行 机 器 人 使 用 大 传动 比 传动 系统 ， 需 考虑 摩擦 、 弹 性 和 
间隙 。 

此 处 只 考虑 直流 电动 机 ， 因 为 它们 是 腿 式 机 器 人 关节 类 型 最 常见 的 电机 。 液 
压 致 动 器 动态 模型 可 以 在 Craig (1989) 与 Sciavicco 和 Siciliano (2000) 书 中 找 
到 ,而 Ogata (1996) 则 介绍 了 不 同型 号 的 气动 执行 机 构 。 直 流转 和 矩 电机 通过 齿 
轮 减速 到 惯性 载荷 的 机 械 模型 如 图 6. 5 所 示 。 转 子 施加 的 转 矩 re 必须 平衡 转子 
和 负载 惯性 ， 这 里 表示 为 等 效 惯 性 J.,。。 同 样 ， 由 于 电动 机 引起 的 阻尼 效应 和 负 
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图 6.5 直流 转 矩 电机 通过 齿轮 减速 到 惯性 负载 的 机 械 模型 
载 摩 擦 必须 平衡 ， 表 示 为 等 效 阻 尼 B.,， 有 


ta — Et =J ea fa + Bead (6. 54) 
式 中 0, 一 一 致 动 器 位 置 ; 
NN 一 一 减速 比 。 
等 效 惯性 和 等 效 阻 尼 计 算式 为 
J 一 Ja 十 去] (6. 55) 
B= Ba +B (6:56) 


传动 系统 是 另 一 个 摩擦 的 来 源 。 黏 性 摩擦 通常 存在 于 有 润滑 的 接触 点 ， 因 此 
应 该 包括 在 等 效 阻 尼 项 B., 中 。 可 能 还 存在 其 他 摩擦 力 ， 如 库仑 摩擦 。 这 个 摩擦 
分 力 代表 传 动 中 的 能 量 损失 ， 用 减速 机 的 机 械 效率 7 来 建 模 。 因 此 ， 在 传动 系统 
中 ， 库 仑 和 黏 性 摩擦 可 以 包含 在 动态 模型 中 ， 即 


无 二 大 于 也 


J (6. 57) 


N’ i 
E 1 
Ba=Bat NB (6. 58) 
然而 ， 这 个 传动 系统 摩擦 力 的 模型 对 某 些 系统 可 能 不 够 准确 。 该 模型 既 不 考 


虑 静摩擦 也 不 考虑 中 合 摩擦 (Garcia 等 ，2002) ， 这 在 高 精度 系统 方面 尤为 显著 。 
在 这 种 情况 下 ， 需 要 准确 的 摩擦 模型 。 大 传动 比 机 器 人 系统 的 完整 摩擦 模型 由 
Garcia 等 人 (2002) 发 现 。 


6.3.3 完整 动力 学 模型 


腿 的 动力 学 模型 由 机 械 部 件 的 动力 学 模型 以 及 致 动 器 和 传动 系统 的 动力 学 模 
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型 组 成 。 考 虑 到 腿 的 机 械 部 分 作为 与 配置 相关 的 负载 ， 相 关 致 动 器 的 转 矩 必须 平 
衡 ， 移 动机 械 部 分 所 需 的 致 动 器 主动 转 矩 来 自 式 (6. 53): 
tN "4, (6.59) 
其 中 NN 是 3X3 的 关节 减速 比 对 角 和 矩阵 。 执 行 机 构 的 位 置 、 速 度 和 加 速度 与 
关节 位 置 、 速 度 和 加 速度 有 关 ， 即 
0,=Ng; 9, =Ng; On=NG (6. 60) 
RP On. Ön, On MA, BE AE ; 
q, q 9 一 一 关节 位 置 、 速 度 和 加 速度 。 
质量 矩阵 卫 可 以 写成 两 个 矩阵 的 相 加 ， 即 
D(q) 一 Di 十 D; (q) (6. 61) 
式 中 Di 一 一 D(gq) 中 常数 项 的 3X3 FARE 
把 式 (6.53), 式 (6.60) BH C6. 61) RAR (6.50) 中 ,得 
t,=N DINO tT (6. 62) 
其 中 
t, =N'D,(0,,)N~! 0, -+N-!H(0,,:0,,) +N COn) +N IF (6.63) 
因此 ， 可 以 考虑 腿 的 机 械 部 分 的 动力 学 作为 两 项 的 总 和 : FA SJSN DNY 
给 出 的 恒定 惯性 和 式 (6. 53) 中 可 变 项 给 出 的 扰动 到。 考虑 到 执行 机 构 转 矩 必 
须 满足 腿 部 动力 学 模型 ， 致 动 器 动力 学 模型 可 以 以 矩阵 形式 表达 为 
Tm =Jeq On +BeqOn +0, Htr (6. 64) 


或 中 ty, 致 动 器 转 矩 的 3X1 矢量 ， 
人 下 一 一 每 个 关节 的 非 黏 性 摩 氛 模型 的 3 多 1 矢量 ， 因 此 不 包括 黏 性 摩 
# Fui 
等 效 惯性 和 等 效 阻 尼 为 
Jeg=JIn FND N! (6. 65) 
B., =B, +F, i (6. 66) 


式 中 Ja ——3 X 3 IAEE, HIR J mi ERITH i 的 转子 惯性 。 
B, 一 一 3X3 FARIA, TOR Bmi 是 致 动 器 i 的 黏 性 摩擦 系数 ; 
下 ,一 一 3X3 WAM, HOR F,; 是 关节 i 的 传动 系统 中 的 黏 性 摩 氛 
系数 。 
式 (6.63) 一 式 (6.66) 完成 机 器 人 腿 或 者 操纵 臂 的 动力 学 模型 ， 注 意 ，7p 
Al ct, 是 非 线 性 项 。ztp 项 还 存在 关节 之 间 的 而 合 ， 此 项 只 有 在 使 用 大 传动 比 的 情 
况 下 被 忽略 ， 式 (6. 64) 中 的 模型 是 解 看 的 。 但 是 在 这 种 情况 下 tt 项 将 增加 其 
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相关 性 ， 模 型 将 变 得 更 加 复杂 。 因 此 ， 有 必要 对 模型 进行 研究 和 分 析 ， 以 获得 准 
确 的 数学 简化 表达 。 l 


6.4 动力 学 模型 分 析 方 法 


由 于 机 器 人 腿 部 动力 学 模型 很 复杂 ， 人 们 通常 用 不 正确 的 简化 模型 来 实现 实 
时 运动 控制 。 由 于 简化 程序 粗略 ， 控 制 将 变 得 不 精确 。 

为 了 精确 地 简化 动力 学 模型 ， 这 里 提出 动力 学 分 析 的 一 种 方法 ， 包 括 以 下 
步骤 : 

(1) 步骤 1: WAR (6. 64) 中 的 每 个 项 ， 覆 盖 实 际 机 器 人 轨迹 的 整个 工作 
空间 。 

(2) 步骤 2: 分 析 每 个 计算 项 的 转 矩 贡献 。 

(3) 步骤 3: 如 果 模 型 中 的 项 对 每 个 轨迹 的 转 矩 贡献 小 于 5%， 那 么 这 个 项 
被 认为 是 不 重要 的 ， 可 以 被 忽略 。 

(4) 步骤 4: 剩 下 的 项 反映 了 动力 学 。 然 后 推导 在 不 同 轨迹 下 的 这 些 重要 项 
WR: @ 作 为 末端 致 动 器 位 置 的 转 矩 的 贡献 趋势 ，@ 作 为 线性 轨迹 速度 的 转 矩 的 
贡献 趋势 ,加 作为 线性 轨迹 加 速度 的 转 矩 的 贡献 趋势 。 

作为 分 析 的 结果 ， 在 机 器 人 执行 任务 时 能 够 识别 机 器 人 动力 学 的 相关 变量 。 
机 器 人 动力 学 和 轨迹 参数 之 间 的 关系 可 以 在 实时 控制 算法 中 应 用 ,或 者 在 最 大 速 
度 的 轨迹 生成 算法 中 应 用 ( 见 第 7 章 )。 


6.5 SILO4 步行 机 器 人 的 应 用 


本 节 旨 在 展示 上 述 动力 学 模型 分 析 方 法 的 用 法 。 对 SILO4 四 足 的 描述 见 附 
录 A， 再 次 测试 分 析 技 术 的 性 能 。 


6.5.1 机 械 零 件 的 动态 模型 


拉 格 朗 日 公式 用 于 推导 出 SILO4 腿 机 械 部 分 的 动态 方程 。 直 接应 用 拉 格 朗 
日 动态 方程 与 D-H 连 杆 坐标 表示 形成 了 紧凑 、 系 统 的 算法 ， 用 于 SILO4 腿 的 
运动 方程 的 描述 。 表 6. 2 列 出 了 所 有 用 于 推导 SILO4 腿 动 力学 方程 的 动态 参数 ， 
使 用 Pro/ENGINEER 机 械 设 计 软 件 (Lamit, 2001) 计算 惯性 力矩 和 质心 位 置 。 
质量 值 通 过 实验 检查 。 

用 拉 格 朗 日 方程 系统 推导 产生 腿 的 机 械 部 分 的 动力 学 方程 [ 式 (6. 53)]。 
SILO4 腿 的 惯性 矩阵 D, Bob HAMR RIRE H 和 重力 矢量 C 在 以 下 段落 中 介 
绍 。Maple V 软件 包 用 于 符号 简化 (Monagan 等 ，1998) 。 
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第 6 章 ， 运动 学 与 动 


表 6.2 用 于 推导 SILO4 腿 动 力学 方程 的 动态 参数 
连 杆 参数 连 杆 1 连 杆 2 
质量 /kg 1:22 | 1. 26 
长 度 /m 0. 06 | 0. 24 
Lan 一 12.2 | —109.4 
co m 的 位 置 
y 101.0 11.4 
(107 4m) 
Tex 
hy 
惯性 张 量 Te 
(10~*kg + m?) 


1. SILO4 腿 的 惯性 矩阵 了 
惯性 矩阵 是 3X3 和 矩阵， 代表 腿 的 两 个 连 杆 之 间 的 惯性 力 。 这 个 和 矩阵 的 一 般 
形式 是 


Di Dz Di; 
D= Do Dy Ds, (6. 67) 
Da D;, Da; 


对 于 不 同 的 足 端 轨迹 ， 对 该 矩阵 的 每 个 元 素 每 一 项 的 贡献 进行 了 分 析 ， 贡 献 
小 于 10 “的 非 重 要 项 被 省 略 。 经 过 这 些 数学 简化 ， 惯 性 矩阵 的 每 个 元 素 具 有 以 
下 最 终 形 式 


Dy, =aC, +bS, +cC; +dC2; +ccos(q3 +2q2) 
+esin(2q,) + fcos(2q,) + gcos(2q3 十 2q2 ) th 
D =0 
DO ~ 68) 
Dz: =kC3 +1 
Dz, =cC; +m 
D;; =m 
其 中 S;=sing;, C;=cosq;, S;=sin(q,;+q;) M C;=cos(q:+q;). 
惯性 矩阵 D 通常 可 分 为 两 个 矩阵 ， 即 
; D=D, +D, (6. 69) 
其 中 D 是 常量 ,， 它 的 元 素 是 对 角 和 矩阵 D 对 角 线 项 的 常数 ， 即 
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D: 由 式 (6.69) 获得 。 常 数 a~m WH 6. 3。 
表 6.3 用 于 SILO4 腿 动 态 模型 的 常数 值 (国际 单位 ) 


数值 
a 0.0376 0.00527 
—0. 00173 5 0. 00581 

t 0.0115 

u 3.077 
—0. 00528 v 一 0. 142 

0. 0317 w% 0. 951 

0. 0105 


2. BCAA RAKE H 
离心 力 和 科 氏 力 矢 量 形式 为 
H= (hih,hs)T (6.71) 
在 分 析 和 简化 之 后 ， 每 个 元 素 为 
hy =hired ge thisqids 
h:=hmqi tho3qd2 qa thos (6. 72) 
hs =hsiqi Hhszq? 


其 中 
/一 一 4S: 十 msin(209: )— gcos(2q2 ) 一 dS; —ksin(2q2 +q: ) + psin(2q: + 2q; ) 
hi = —cS3 —d S23 —csin(2q2 Hq: ) + psin(2q2 十 203 ) 
hoy, =qS2+ fsin(2q2) +rcos(2q2) 十 5S2 十 csin(20 +q3) + gsin(2g; + 2q3 ) 
hz23 = — kS; (6. 73) 
ho33 = — cS; 
hay, =tS; +sS23 +tsin(2q, +q3) + gsin(2q, +2q;) 
h322 =cS3 

常数 a~t WH 6.3. 

3. EAMKEG 

重力 项 矢量 形式 为 

G=(gigign' (6. 74) 


g2 =uCzvS; +wlr; C6-75) 
g3 = wly; FAS 
常数 u~a WR 6. 3。 


6.5.2 执行 机 构 的 动力 学 模型 


SILO4 的 致 动 器 是 3 个 位 于 关节 处 的 低 惯量 直流 电机 通过 齿轮 减速 驱动 负 
载 。 第 一 个 关节 致 动 器 通过 行星 齿轮 连接 ;第 二 和 第 三 个 关节 有 一 个 行星 齿轮 加 
一 个 螺旋 齿轮 (图 6.6)。 因 此 ， 第 一 台 关 节 电 机 装配 将 与 图 6.5 中 的 模型 相 匹 
配 ， 而 第 二 和 第 三 个 关节 的 关节 电机 组 件 具 有 两 级 齿轮 ， 因 此 模型 更 复杂 。 要 实 
现 这 些 致 动 器 的 精确 模型 ， 我 们 应 该 记 住 它 们 是 非 理 想 的 致 动 器 。 每 级 齿轮 都 有 
库仑 、 黏 性 和 吵 合 摩擦 的 转 矩 损失 ， 即 Garcia A (2002) 提出 的 摩擦 模型 


螺旋 齿轮 (1 : N) 


图 6.6 SILO4 腿 第 二 关节 和 第 三 关节 的 传动 和 齿轮 


tri = [tot (te—te eno wlis +A, sinlo Om +) 二 Are Biml sin (coe Om: +>) signal mi) 


C6. 76) 
式 中 i 一 一 关节 号 码 ; 
TE 静摩擦 值 ; 
rc ECCERE; 
0s 一 一 表征 Stribeck 效应 的 Stribeck 速度 ; 
Ai, wi 位 置 相关 摩擦 的 幅 值 和 频率 ; 
Az, wz 可 变 幅 值 的 哮 合 摩擦 分 量 和 频率 。 


传动 系统 的 黏 性 摩擦 下, 被 包括 在 致 动 器 的 等 效 阻尼 项 中 。SILO4 的 摩擦 参 
数 已 经 确定 ， 见 表 6. 4 一 表 6. 6。 采 用 最 小 二 乘法 进行 参数 识别 ， 详 见 Garcia 等 
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《2002) 。 然 后 分 别 命名 关节 i 的 转子 惯量 和 阻尼 为 J A Bass TOBE A Ai 
轮 之 间 的 弹性 连接 元 件 的 转子 惯量 和 阻尼 为 J; 和 B。。 对 于 3 个 关节 的 腿 电机 组 
件 来 说 式 (6. 64) 的 转 矩 平衡 公式 为 


Tmi — Tp — Tri = (J m HNG A) Ô m H Bm HFa Ôm (6. 77) 
Tm2 — Tp2 TF2 =(J m2 十 NB Je + Ni? NZD 8 mo + (Baz + No? Be +F 3 )Oe2 
(6. 78) 


Tm3 Tp3 TF3 Sa +N’ Ja HN Nz D ma + (Bars 十 NB + Fy) Ons 


(6. 79) 


6.4 SILO4 腿 的 第 一 关节 的 摩擦 参数 


6s/Cr min-!) B/(10-3N* mer! + min) 


2. 97 38.4 0. 00264 


2.97 38. 4 
wı/(rad * s7!) $ı/rad 


3.5% 10-* 0 


0. 00264 


3.5% 10-3 


B2/(r .min 1) oz/(rad + s~!) 


pz / rad 


6.51078 1 


5.7X1078 1 


6.5 SILO4 腿 的 第 二 关节 的 摩擦 参数 


re/(10-3N， 


te/(10 3N* m) Beer ny B/(10-N。m。r 1。min) 


34. 91 34. 48 5691 0. 00123 


34. 99- 34. 53 5702 


$ı/rad 


0. 00086 


Ai/(10-3N 。 wi/(rad®*s 1) 


3.5X10~3 


3.5 X11073 


B2/(r + min™!) w2/(rad * s7!) $2 /rad 
3.1X 1071! 0.071 16:2 
1.2X10-4 0.071 1.2 


旋转 方向 Adao-N m | B3/(r + min™!) w3/(rad +s!) $;/rad 
JE 0.25 5.8X107!5 | 1 —nx/3 
负 0.910715 1 —x/3 


第 6 章 


A;/(10-3N * m) 


0.3 3.5 10-* 
0.3 3.5X 107 
A2/(10-3N + m) B2/(r* min~!) w2/(rad* s7!) 
正 0. 576 1.274104 0. 071 n/2 
负 0. 526 142X104 0. 071 n/2 


A3/(10~3N * m) Bs/Cr* min™!) w3/(rad* s 1) 
5.8X10 一 5 


1 


致 动 器 动态 参数 见 表 6.7。 扰 动 转 矩 rr 、rz 和 rm 是 腿 部 关节 1 一 3 所 需 的 转 
矩 ， 分 别 遵循 给 定 的 轨迹 并 从 式 (6.63) 获得 


z 一 NT-1D;(g)N-10 mp +N HOn, 8m +N CO, IHN ITF (6. 80) 


其 中 
Fo = (Tm Toe Ts)” (6. 81) 
Nao 0 0 
N=|0 NNa ô (6. 82) 
0 0 Np Ns 
表 6.7 致 动 器 动态 参数 
参 数 致 动 器 1 致 动 器 2 致 动 器 3 
Ja/(10-skg。m2) 2.3 6.4 4.9 
Bm/(0-*N+meradt +s!) | ie | 9.14 3.0 
R/O | 10.5 2.0 5.5 
L/ (10-3H) | 0. 94 0.27 0. 85 
Km/(10-3N + m+ AW?!) 46. 81 42. 88 41.05 
Ke/CV • rad~! + Av!) 0. 039 is 0. 043 0. 041 
N, 246 14 14 
行星 齿轮 
np/ % 60 80 80 
螺旋 齿轮 Ns | 20.5 20.5 
ns/% | 70 70 
B: 0 0 
J./C0~Skg + m?) 


141 


6.5.3 模型 分 析 


获得 SILO4 腿 部 的 数学 模型 后 就 可 以 进行 模型 分 析 。 首 先 ， 使 用 SILO4 腿 


图 6.7 用 于 实验 的 SILO4 
腿 部 原型 


i 
1 


Tp, /(N * m) 


部 原型 (图 6.7) 分 析 真 实 腿 部 轨迹 机 械 部 件 的 
转 矩 贡献 和 致 动 器 动力 学 的 转 矩 贡献 并 进行 比 
较 。 众 所 周知 ， 准 确 高 效 的 模型 分 析 需 要 选择 具 
有 完整 激励 特征 的 轨迹 。SILO4 腿 部 模型 的 分 析 
所 选择 的 轨迹 具有 最 高 的 加 速度 ， 可 提供 足够 的 
动态 激励 。 用 于 生成 这 种 改进 轨迹 的 算法 在 第 7 
章 详 细 介绍 。 以 下 进行 实验 以 获得 腿 的 机 械 部 件 
和 致 动 器 的 转 矩 贡献 ， 每 个 关节 都 是 PID 控 
制 的 。 

1. 机 械 部 件 的 转 佐 

分 析 腿 部 机 械 部 件 的 动力 学 ， 将 数学 模型 
中 的 每 一 项 转 矩 与 实际 中 腿 的 摆动 轨迹 进行 比 
较 。 图 6. 8 所 示 为 相应 的 机 械 部 件 模型 中 4 项 
AY Fe, BD 


0 0.1 0.2 0.3 0.4 
t 
(a) tp, /s 
0.2 
E 
> 0.1 
z 
Rs 
下 


1 
0 0. 1 0.2 


Co) ty 


— KF 1 


| j L 
0.3 0.4 0 0.1 0. 2 0.3 0.4 


a's (d) ze tye 


-一 -关节 2 ee 关节 3 


图 6.8 SILO4 腿 部 机 械 部 件 的 转 和 矩 
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(6. 83) 
Ty = H(q>q) 
T =C(q) 
其 中 腿 部 机 械 部 件 的 总 转 矩 为 
Te 一 7pl 十 7pz 十 TH 十 Tc (6. 84) 
总 扰动 转 矩 mr 的 项 为 
Tp = Toz 十 TH 十 Tc (6. 85) 


其 中 ro 项 对 致 动 器 的 等 效 惯 量 有 影响 ， 其 沿 着 给 定 腿 部 轨迹 的 转 矩 随时 间 
的 变化 如 图 6. 8 (a) 所 示 ， 其 中 每 条 线 显 示 用 以 移动 其 自身 连 杆 恒定 惯量 每 个 
关节 所 需 的 转 矩 (矢量 mm). FEER, B 6.8 (b) 表示 非常 数 和 非 对 角 惯性 项 
Wee (Kitt), A6.8 (c) 表示 离心 力 和 科 氏 力 〈 矢 量 tn) 的 转 矩 ， 图 6. 8 
(d) 表示 重力 作用 的 转 矩 〈 矢 量 rc) 。 

动力 学 模型 中 四 项 的 详细 数值 比较 显示 ， 在 腿 部 动力 学 的 作用 力 中 ， 离 心力 
和 科 氏 力 效 应 发 挥 了 很 小 的 作用 [图 6.8 (c)]。 这 可 以 在 图 6.9 中 更 清楚 地 观 
察 到 ， 所 有 的 转 抢 已 经 绘制 在 一 起 。 很 明显 ，ra 可 以 忽略 不 计 。 重 力 项 的 作用 
在 关节 2 和 关节 3 的 运动 中 是 显著 的 ， 惯 性 的 作用 对 关节 1 是 显著 的 。 图 6. 10 
所 示 为 每 个 关节 的 总 扰动 转 矩 [ 式 (6. 85)] 中 的 r* ， 并 将 其 与 从 式 (6. 85) 易 
BR rn 获得 的 简化 扰动 转 矩 进行 比较 ， 即 


全 一 TDpz 十 Tc (6. 86) 
图 6. 10 显示 了 简化 出 现 的 最 大 误差 ， 在 最 坏 的 情况 下 为 4 2% « 
2. 5A 
os 十 
liiin na 
2 Hehe eee tet 
< 
时 
& ne —Tp (1) 
-TD2 (2) 
1.0 == Tp2 (3) 
© TH (1) 
+ TH (2) 
0.5 x TH (3) 
om Be (1) 
+ Tc (2) 
o rc (3) 


—0. 5+-990000OO00¢, 
Q 
2000000000000000 


Nees 1 1 f | | 
0. 05 0. 10 0.15 0. 20 0. 25 0. 30 0. 35 
t/s 


图 6.9 SILO4 腿 部 机 械 部 件 转 矩 的 数值 比较 
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控制 技术 


人 
E 
。 2.0b IR og 
BO 
g 1.5} Errormx= 1.8% 
3 r8 (1) 
1.0} -TE (2) 
-TP (3) 
Tp a) 
0.5- Errormx=0.3% +p (2) 
EEEREN, 人 rp (3) 
OF 
= OE a tet 
==1]1,0 L 1 1 1 L | 
0 0. 05 0.10 0. 15 0. 20 0:25 0. 30 0. 35 


图 6.10 SILO4 腿 部 的 扰动 转 和 矩 m PE AE HS HÈ ON PE Bc; 


总 结对 腿 部 机 械 部 件 的 分 析 , 可 见 影响 SILO4 腿 部 关节 1 动力 学 最 大 的 是 惯性 ， 
影响 关节 2 和 关节 3 动力 学 的 主要 是 重力 影响 ， 惯 性 在 这 两 个 关节 中 发 挥 次 要 作用 。 

2. ROBE RW te E 

图 6. 11 所 示 为 在 给 定 的 腿 部 轨迹 中 的 致 动 器 的 摩擦 力 和 等 效 惯性 产生 的 转 
E. 。 致 动 器 等 效 惯量 包括 腿 部 机 械 部 件 的 恒定 惯量 Di WR (6.77) 一 式 
(6.79) 。 实 际 轨迹 下 腿 的 摩 氛 转 矩 见 式 〈6. 76)。 通 过 这 两 个 数字 的 比较 ， 可 以 
看 出 关节 2 和 关节 3 的 摩擦 力 是 惯性 的 两 倍 。 而 在 关节 1 中 惯性 比 摩擦 力 更 为 重 
要 。 但 无 论 如 何 ， 摩 擦 力 绝对 不 可 忽视 。 因 此， 高 传动 比 机 器 人 系统 的 摩擦 力 足 
以 阻碍 模型 简化 的 初步 猜测 在 这 里 得 到 验证 。 即 摩擦 主导 了 致 动 器 2 和 致 动 器 3 
的 动力 学 。 因 此 ， 假 设 没有 摩擦 存在 的 简化 模型 会 导致 步行 机 器 人 的 动力 学 模型 
在 运动 控制 期 间 产生 显著 的 误差 。 


转 矩 /(N。my) 
转 矩 /C(N“，m) 


0.4 

t/s 

Ca) 致 动 器 等 效 惯性 的 转 矩 Ch) 在 致 动 器 传动 系统 中 摩擦 力 的 转 和 矩 
一 关 沁 了 pa wm 关节 3 


图 6.11 致 动 器 等 效 惯性 和 在 致 动 器 传动 系统 中 摩擦 力 的 转 矩 
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图 6. 12 用 于 显示 腿 部 机 械 部 件 对 致 动 器 动力 学 的 扰动 效应 。 对 于 图 6. 12 中 示例 
轨迹 ， 扰 动 可 以 认为 是 致 动 器 2 ABBA 3 的 常数 。 然 而 ， 由 于 存在 可 变 惯量 D, , 
致 动 器 1 中 的 扰动 不 是 恒定 的 ， 但 几乎 可 以 忽略 不 计 。 图 6. 13 (a) 所 示 为 不 同 的 轨 
迹 ， 忽 略 了 致 动 器 1 的 扰动 相对 于 惯性 力矩 的 最 大 误差 ， 这 个 误差 总 是 小 于 0. 5%。 


TE 致 动 器 1 
一 -- 致 动 器 2 
E 一 致 动 器 3 
| 一致 动 器 1 十 rpl 
Z 107 十 致 动 器 2 十 rr 
W 令 致 动 器 3 十 rps 
# ds 
| We 
mis 
= 0 Sr ds 
15 f h fi 1 ee ene 
0 0. 05 0. 10 0. 15 0. 20 0. 25 0. 30 0. 35 
t/s 


图 6.12 ” 致 动 器 模型 的 转 矩 和 SILO4 腿 部 机 械 部 件 的 扰动 的 影响 


定义 腿 的 水 平展 宽 为 Ri， 即 从 末端 致 动 器 到 腿 部 参考 坐标 系 原点 水 平 投影 
的 距离 如 图 6. 14 所 示 。 
R, =a; cos(q2 十 gs ) Fa: cosq (6. 87) 
关节 2 和 关节 3 动力 学 的 主要 扰动 是 重力 ， 并 且 该 影响 随 着 腿 部 的 水 平 延伸 
而 增加 ， 如 图 6. 13 (b) 和 图 6.13 〈c) Bray. 
对 SILO4 腿 动 力学 模型 的 分 析 得 出 结论 ， 关 节 1 上 的 机 械 部 件 的 动力 学 可 
以 忽略 不 计 。 机 械 部 件 在 关节 2 和 关节 3 上 的 扰动 随 着 腿 的 水 平 延 伸 而 变化 。 基 
于 此 考虑 ， 可 以 简化 模型 ， 又 不 失 准 确 性 。 然 后 简化 腿 部 机 械 部 件 对 3 个 致 动 器 
的 扰动 转 和 矩 toa the 和 rhs 为 ; 
Ta = 0 (6. 88) 


t =m:R, (qz 1q) tbe (6. 89) 
Th =m; R, (qs »03 ) +b; (6. 90) 


HP ri, hF R, 之 间 的 关系 已 经 被 线性 化 。 
简化 SILO4 腿 动 力学 模型 后 ， 关 节 2 和 关节 3 是 耦合 的 ， 而 关节 1 是 独立 
的 。 该 分 析 能 够 使 基于 模型 的 控制 策略 更 有 效 。 模 型 分 析 的 结果 在 第 7 章 中 


TB 
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Cb) 增加 水 平展 宽 时 rpz 的 演变 
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Co) 增加 水 平展 宽 时 tps 的 演变 


图 6.13 不 同 水 平展 宽 下 SILO4 腿 部 机 械 部 件 的 扰动 转 矩 


图 6.14 机 器 人 腿 的 展 宽 


许多 作者 建议 在 步行 机 器 人 控制 中 不 考虑 腿 的 动力 学 。 高 传动 比 传动 系统 就 
忽略 了 腿 动力 学 对 轨迹 控制 的 影响 。 但 是 ， 使 用 高 减速 比 来 减 小 腿 动力 学 意味 着 
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传动 系统 中 的 间隙 、 摩 扩 和 弹性 会 显著 增加 。 这 些 额 外 影响 比 机 械 部 件 的 动态 模 
拟 更 难 。 本 章 的 一 个 主要 结论 是 机 器 大 腿 部 作为 无 质量 系统 并 不 总 是 最 好 的 选 
择 ， 腿 动力 学 效应 是 可 以 建 模 的 ， 并 可 以 用 来 改善 控制 系统 。 为 了 说 明 这 一 点 ， 
本 章 得 出 了 一 个 机 器 人 腿 部 的 精确 模型 。 通 过 使 用 真实 的 腿 部 原型 进行 实验 ， 分 
析 实 际 腿 部 轨迹 下 不 同 动力 项 的 转 矩 贡献 。 通 过 对 腿 动 力学 的 详细 分 析 对 模型 进 
行 简 化 ， 获 得 腿 部 运动 控制 的 动力 学 精确 模型 。 
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速度 的 软 计算 技术 


Okt 


防 第 7 章 提高 腿 


7.1 简介 


为 了 实现 步行 机 器 人 的 实际 应 用 ， 需 要 改进 当前 步行 机 器 人 的 性 能 。 步 行 机 
器 人 的 反对 者 ， 通 常 将 机 器 速度 作为 此 类 移动 装备 主要 缺点 之 一 。 步 行 机 器 人 腿 
部 必须 设计 为 在 比 机 械 手 更 差 的 负载 条 件 下 工作 ， 机 械 结构 性 能 较 差 ， 同 时 还 需 
具有 良好 的 精度 。 例 如 ,设计 用 于 携带 3kg 有 效 载荷 的 商业 机 械 手 重量 约 50kg, 
结构 刚性 很 好 。 而 一 条 用 于 SILO4 步行 机 器 人 的 腿 ， 重 量 仅 为 4kg， 但 必须 在 
足 的 位 置 支撑 高 达 15kg (机 器 重量 的 一 半 ) 的 载荷 。 通 常情 况 下 ， 腿 部 的 大 载 
荷 通过 使 用 高 速 比 齿 轮 传动 ， 降 低速 度 ， 增 加 输出 转 矩 ;因此 腿 的 速度 比 机 械 手 
慢 。 但 腿 部 速度 可 通过 在 轨迹 生成 时 采用 接近 极限 的 驱动 速度 来 改进 。 

用 于 户外 自然 地 面 的 步行 机 器 人 通常 需要 跨越 障碍 ， 如 岩石 或 树木 等 障碍 
物 ， 可 能 会 中 止 足 端 轨 迹 。 为 了 应 对 这 种 不 便 ， 腿 部 轨迹 必须 在 线 生 成 ， 以 避免 
每 次 跨越 障碍 物 时 重复 产生 完整 轨迹 ， 造 成 计算 负担 。 因 此 可 以 通过 在 线 轨迹 生 
成 提高 腿 的 速度 。 本 章 着 重 介 绍 生成 在 线 轨迹 来 提高 腿 的 速度 。7. 2 节 举 了 一 些 
实例 说 明 该 问题 ， 并 列举 了 解决 方法 。7. 3 节 介 绍 系统 模糊 推理 方法 。 最 后 ， 
7.4 节 为 实验 结果 。 


7.2 提高 在 线 轨迹 生成 中 的 腿 部 速度 


机 器 人 每 个 腿 的 个 旋转 关节 都 存在 转 和 矩 限制 ， 使 其 不 可 能 基于 关节 角速度 
同步 获得 足 的 高 速 笛 卡 儿 轨 迹 。 
足 端 轨迹 和 运动 平面 如 图 7.1 所 示 。 图 7.1 显示 了 3 自由 度 腿 的 足 端 直线 轨 
迹 I 一 F 的 初始 位 置 和 最 终 位 置 。 定 义 一 个 由 平面 轨迹 I 一 F 和 腿 参 考 坐 标 系 的 
原点 O 组 成 的 平面 ， 将 其 标记 为 平面 TOF。 可 以 通过 使 用 虚拟 的 2 自由 度 腿 来 
执行 轨迹 I 一 F， 其 中 一 个 旋转 关节 放置 在 原点 O 处 ， 与 平面 IOF 正 交 ， 一 个 伸 
缩 关 节 将 腿 部 的 长 度 延伸 一 段 距离 R(t1)。 因 此 ， 足 部 的 笛 卡 儿 运 动 在 腿 部 的 参 
考 坐 标 系 nayza 以 变量 RO) MOG) 表示， 给 出 
X1(t)=R(t) cosL0()] (7.1) 


148 


第 7 章 提高 腿 部 速度 的 软 计算 
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最 终 足 位 置 人 
Fa, Fy Fad N 
图 7.1 足 端 轨迹 和 运动 平面 
y(t) =R(t)sin[O() | (7. 2) 
MÈ (7.1) MR (7. 2) 可 得 足 速度 的 笛 卡 儿 分 量 为 
ti) =R(t)cosO(t) 一 0 (4) R(t) sin (2) J (7.35 
9 (t) =R(t)sind(t) —4 (2) R(t) coslo) ] (7.4) 


从 式 (7.3) 和 式 (7.4) 得 到 足 的 线 速度 为 


ERG HRO O (7.5) 

根据 式 (7.5), RAKE BBBKILIOD. RG) 和 R(t)。 应 对 不 同 的 任务 

要 求 ， 最 大 化 R(1) 不 总 是 可 行 的 。 最 大 化 9(1) MRO) 受 最 大 关节 速度 的 限 

制 ， 因 为 9() AR) 都 是 根据 实际 3 自由 度 腿 9;(1) (i 二 1,2,…,n) 的 关节 
角度 和 关节 速度 来 定义 的 : 

O60) UNORE AOR AORE AON SAR 

R(t) =g), 0n CL) 0, Ay ,0, (2) J (7, 7) 

HTHH, 图 7.2 示 出 了 SILO4 腿 的 关节 角速度 如 何 影 响 足 的 平均 速度 。 

梯形 的 足 速度 曲线 用 于 直线 轨迹 生成 ， 为 了 不 同 的 y 坐标 值 ， 如 图 7. 2 所 示 的 轨 

迹 平行 于 腿 的 z+ 轴 。 图 7.2 (a) 所 示 为 SILO4 腿 的 关节 1 的 角速度 曲线 ， 关 节 

1 是 相同 轨迹 下 首先 达到 其 速度 极限 的 关节 。 图 7.2 显示， 关节 速度 达到 由 致 动 

器 最 大 转 矩 给 定 的 最 大 驱动 速度 ， 对 于 更 接近 腿 原点 OND, hE RG) 的 

较 短 值 ， 并 且 阻 止 了 所 需 的 平均 足 速 度 ， 如 图 7.2 (b) 中 所 示 。 相 反 ， 对 于 远 
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Ca) 关节 1 角速度 变化 曲线 Cb) 足 速度 变化 曲线 
图 7.2 平行 于 腿 部 ziy 平面 的 足 端 轨迹 


离 原点 O 的 轨迹 ， 即 R(t) 值 越 高 ， 实 现 相同 平均 足 端 速度 所 需 的 角速度 就 越 
低 。 因 此 ， 对 较 高 的 RO) 值 足 端 速度 可 以 增加 ， 直 到 关节 1 的 致 动 器 达到 其 速 
度 限 值 。 

该 实验 表明 ， 改 善 足 的 直线 速度 需要 修改 足 速度 曲线 以 适应 腿 工作 空间 的 每 


个 轨迹 。 足 速度 曲线 的 修改 基于 至 少 一 个 致 动 器 达到 速度 极限 ， 以 实现 0(z) 和 


R(t) 最 大 化 。 这 种 解决 方案 来 自 最 小 时 间 控 制 技术 (Bobrow 4, 1985; Shin 
和 McKay, 1985; Yang 和 Slotine，1994)。 但 由 于 其 计算 复杂 ， 不 适用 于 在 线 
轨迹 生成 。 此 外 ， 最 小 时 间 控 制 理论 假定 腿 部 的 完美 精确 模型 是 可 用 的 ， 并 且 没 
有 外 部 和 干扰。 然而， 实际 上 不 可 能 获得 这 样 的 理想 模型 。 

最 近 提 出 通过 模糊 推理 提高 步行 机 器 人 在 线 生成 轨迹 的 足 端 速度 的 方法 
(Garcia 和 Gonzalez de Santos，2001) 。 当 无 法 获得 系统 的 数学 模型 时 ， 特 别 推 
荐 模糊 集 理 论 的 应 用 。 此 外 ， 模 糊 规 则 提供 了 真实 机 器 上 存在 的 不 确定 性 参数 的 
良好 估计 ， 是 系统 真正 动态 效果 的 有 效 表示 ， 避 免 了 耗 时 的 数学 模型 。 以 下 部 分 
所 述 的 加 速度 调整 方法 ， 是 基于 生成 的 梯形 足 端 速度 曲线 更 好 地 适应 轨迹 参数 ， 
实现 至 少 一 个 致 动 器 达到 速度 极限 。 然 而 ， 使 用 给 定 的 速度 曲线 所 得 到 的 足 端 直 
线 速度 低 于 使 用 最 小 时 间 算 法 实现 的 理论 速度 。 图 7. 3 所 示 为 在 相 平面 使 用 最 小 
时 间 控 制 和 加 速度 调整 理论 方法 产生 的 两 个 轨迹 的 比较 ， 同 时 给 出 了 通过 致 动 顺 
转 和 矩 限 制 和 腿 部 动力 学 所 得 的 速度 限制 曲线 。 图 7. 3 中 ， 基 于 梯形 足 端 速度 曲线 
的 轨迹 与 速度 限制 曲线 最 低 点 相 切 ， 沿 着 加 速 和 减速 之 间 的 轨迹 保持 速度 值 恒 
定 。 相 比 之 下 ， 使 用 最 小 时 间 方 法 生成 的 轨迹 与 速度 限制 曲线 相 切 于 几 个 点 ， 因 
此 在 整 段 轨迹 更 具有 适应 性 。 因 此 ， 使 用 最 小 时 间 达 到 平均 速度 比 通过 加 速度 调 
整 方 法 获得 的 速度 更 快 。 然 而 ， 加 速度 调整 方法 能 够 在 线 生成 梯形 速度 曲线 来 实 
现 最 快速 度 。 


150 


a — 基于 加 速度 调整 的 轨迹 
s 一 一 = 最 小 时 间 轨 迹 


Cso ,50) (sf ssp) 
5 


图 7.3 相 平 面 内 最 小 时 间 轨 迹 和 基于 
加 速度 调整 的 轨迹 


7.3 加 速度 调整 方法 


考虑 腿 部 工作 空间 内 的 两 种 轨迹 。 第 一 种 是 RO) 较 小 时 的 轨迹 ， 其 最 大 平 
均 足 端 速度 在 很 大 程度 上 取决 于 电机 的 转速 ， 见 式 (7. 5) 。 足 端 直线 速度 受 驱动 
器 限制 ， 更 强大 的 驱动 器 才能 增加 这 种 轨迹 的 平均 足 端 速度 。 第 二 种 是 较 大 
R(t) 的 轨迹 ， 如 果 驱 动 速度 提高 到 极限 ， 则 可 以 达到 极 高 的 足 端 速度 。 可 以 使 
用 具有 给 定 足 端 加 速度 的 梯形 速度 分 布 生成 轨迹 图 7.4)， 其 中 vw 为 足 的 平均 
速度 ，t, Al ta 分 别 为 加 速 时 间 和 减速 时 间 。 对 于 第 二 种 轨迹 ， 可 以 限制 足 端 速 
度 的 唯一 因素 是 速度 曲线 的 加 速度 。 因 此 ， 提 高 这 种 轨迹 的 平均 足 端 速度 可 以 通 
过 提高 足 端 加 速度 来 实现 。 然 而 ， 提 高 速度 曲线 的 加 速度 在 实际 机 械 系 统 中 并 不 
总 是 可 行 的 方案 。 腿 部 动力 特性 阻止 阶 路 速度 曲线 ， 即 不 可 能 具有 无 限 大 的 加 速 
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图 7.4 用 于 轨迹 生成 的 梯形 足 端 速度 分 布 
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度 。 因 此 ,考虑 到 腿 部 动力 学 影响 ， 不 能 使 用 复杂 的 数学 模型 来 在 线 生 成 轨迹 。 
为 每 种 特定 类 型 的 轨迹 找到 适当 的 速度 曲线 ， 是 加 速度 调整 方法 的 主要 目标 。 

较 高 加 速度 的 足 端 速度 曲线 可 能 有 助 于 实现 更 高 的 足 端 速度 。 对 于 短 轨迹 
Oiso] 足 端 速度 曲线 变 成 三 角形 ， 因 此 只 能 获得 较 小 的 平均 足 端 速度 。 增 加 
足 端 加 速度 后 在 高 速 下 可 执行 短 轨迹 。 图 7.5 所 示 为 相同 摆动 距离 的 两 种 足 端 速 
度 曲线 。 轮 廓 (1) 具有 比 轮廓 (2) 更 低 的 足 端 加 速度 ， 因 此 不 会 达到 第 (2) 
轮廓 的 平均 速度 值 ws 。 然 而 ， 在 某 些 情况 下 ， 腿 部 动力 学 效应 会 严重 限制 足 端 
加 速度 。6. 5. 3 节 显 示 ， 影 响 3 自由 度 关节 腿 (如 SILO4 腿 ) 运动 的 动力 效应 是 
由 自身 加 速度 引起 的 腿 部 第 一 关节 的 惯性 效应 以 及 关节 2 和 关节 3 的 重力 作用 。 
实际 观察 腿 部 运动 的 动态 效应 : 当 足 轨迹 具有 大 的 = 分 量 增 量 时 , 平面 IOF JL 
乎 是 垂直 的 ， 并 且 图 7. 1 中 的 角度 0 主要 由 腿 部 的 关节 2 和 关节 3 限定 ,特别 是 
关节 3 在 足 端 速度 曲线 的 加 速 期 间 达 到 其 最 大 绝对 角速度 (关节 3 的 最 大 驱动 转 
和 矩 小 于 关节 2; 如 图 7.6 所 示 )。 这 意味 着 高 速 抬 高 足 增 大 了 关节 3 所 要 求 的 内 
部 加 速度 ， 而 腿 部 动力 效应 则 阻止 这 种 运动 (由 于 自重 ， 从 6. 5. 3 节 注 意 到 关节 
2 和 关节 3 主要 受到 重力 影响 )。 同 理 ， 承受 机 器 人 的 重量 重力 会 影响 腿 的 向 下 
运动 。 还 要 注意 ，SILO4 腿 的 关节 2 和 关节 3 具有 交错 轴 齿 轮 (参见 附录 AD, 
其 呈现 由 摩擦 力 和 间隙 引 起 的 非 线 性 。 人 恒定 的 重力 扰动 再 加 上 非 线 性 摩擦 和 间 际 
作用 可 能 导致 在 线 生成 算法 中 的 误差 ， 导致 足 端 高 速 向 上 运动 初始 时 的 振荡 。 找 
到 准确 和 简单 的 计算 动态 效应 的 数学 模型 是 必需 的 。 模 糊 理论 是 解决 不 存在 数学 
模型 的 非 线 性 系统 问题 的 适用 工具 。 因 此 ， 可 用 这 种 软 计算 技术 将 影响 腿 部 运动 
的 动力 学 因素 引入 足 端 加 速度 调整 算法 ， 为 每 个 轨迹 提供 足 部 的 最 佳 加 速度 值 。 
根据 这 种 思路 可 以 得 出 结论 ， 根 据 轨 迹 参数 和 腿 部 动力 学 参数 的 模糊 足 端 加 速度 
调节 可 以 改善 腿 部 运动 性 能 。 本 章 的 主要 目的 是 研究 足 端 速度 曲线 上 的 加 速度 变 
化 如 何 影响 腿 部 性 能 。 

加 速度 调整 方法 如 下 : 

| 


1 
人 
| 
l 
| 
| 
| 
L 


Yu 
tii» tiz ta2sta2 tarsta tf2 tm t 


图 7.5 相同 摆动 距离 的 两 种 足 端 速度 曲线 
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关节 速度 /(rad。s-1) 


0 0. 5 1.0 1.5 2.0 


图 7.6 SILO4 腿 角 关节 以 0. Im /s 的 速度 从 腿 部 位 置 
(0, 0.350, —0. 400) Æ (0, 0.350, 0.200) REE 


(1) 考虑 驱动 器 限制 的 实验 工作 空间 分 区 。 实 验 确定 轨迹 参数 值 的 范围 。 也 
就 是 说 ， 必 须 确定 轨迹 距离 、 平 均 速度 和 加 速度 范围 。 

(2) 模糊 集 和 规则 。 轨 迹 参数 转换 为 模糊 语言 变量 ， 并 通过 划分 每 个 变量 的 
区 间 来 定义 模糊 集 。 

(3) 推理 图 计算 。 将 模糊 推理 系统 直接 应 用 于 语言 变量 。 

其 结果 是 获得 足 端的 加 速度 和 轨迹 参数 之 间 的 关系 。 

图 7. 7 所 示 为 足 端 轨迹 控制 系统 框图 。 足 部 定位 系统 采用 经 典 方案 。 虚 线 拢 
形 内 的 块 对 应 于 足 端 加 速度 调整 方法 。 

以 下 部 分 描述 了 SILO4 足 端 速度 改进 中 加 速度 调整 方法 的 3 个 步骤 。 


7.3.1 工作 空间 实验 分 区 


加 速度 调整 方法 的 第 一 步 是 识别 足 端 线 速度 受 驱动 限制 的 腿 部 工作 空间 内 的 
轨迹 。 与 腿 部 zi 轴 平 行 的 轨迹 的 速度 曲线 如 图 7.8 所 示 。 图 7.8 (a) 为 平行 于 
SILO4 腿 的 2, 轴 轨 迹 的 梯形 足 端 速度 分 布 。 所 有 轨迹 具有 相同 的 长 度 和 平均 足 
速度 。 图 7.8 b) ~ (d) 分 别 为 腿 部 的 关节 1 一 关节 3 的 角速度 分 布 。 从 图 
7. 8 中 可 以 得 出 ， 对 于 靠近 腿 根 部 的 轨迹 ， 腿 部 关节 1 达到 致 动 器 转 矩 极限 时 的 
速度 低 于 关节 2 和 关节 3 达到 其 驱动 极限 的 足 端 速度 。 因 此 ， 对 于 这 些 轨 迹 ， 对 
坐标 yi 的 每 个 值 ， 加 速度 调整 方法 调整 足 端 加 速度 以 提高 足 端 速度 ， 直 到 该 致 
动 器 达到 其 转 矩 极限 。 
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图 7.7 足 端 轨 迹 控制 系统 框图 
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图 7.8 与 腿 部 x 轴 平行 的 轨迹 的 速度 曲线 
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; rp We 


对 平行 于 SILO4 腿 的 yi 轴 和 =, 轴 的 足 端 轨迹 进行 相同 的 实验 。 对 于 这 两 种 
轨迹 ， 关 节 3 限制 了 足 端 速度 (图 7.9)。 因 此 ， 加 速度 调整 方法 应 调整 足 端 加 
速度 以 提高 足 端 速度 ， 直 到 致 动 器 3 达到 其 转 矩 极限 。 


MD 


01/ (rad + s~?) 


v/(10-3mes 


62/(rad + s-1) 


63/ (rad * s71) 


Jp = 
Cios, 0 一 360 
m) 


(c) 关节 2 的 角速度 (d) 关节 3 的 角速度 


300 
Zy 


图 7.9 与 腿 部 = 轴 平 行 的 轨迹 的 速度 曲线 


图 7.9 (d) 所 示 为 关节 3 在 加 速 期 间 由 于 腿 部 动力 学 引起 的 误差 达到 转 短 
极限 ， 阻 止 了 采用 垂直 轨迹 时 足 端 加 速度 的 增加 。 在 加 速度 调整 方法 中 必须 考虑 
这 种 情况 。 

本 实验 研究 总 结 如 下 : 

CL) 为 了 获得 更 高 的 足 端 速度 ， 有 必要 增加 短 轨迹 的 足 端 加 速度 。 

(2) 当 轨 迹 较 长 时 ， 足 端 加 速度 应 适中 。 在 长 轨迹 的 情况 下 ， 非 常 高 的 足 端 
加 速度 值 不 适用 ， 因 为 伸展 的 腿 部 姿势 会 导致 其 他 关节 的 驱动 限制 。 用 适度 的 加 
速度 值 可 避免 足 端 的 振荡 响应 。 

G) 足 部 垂直 运动 时 应 减 小 足 部 加 速度 ， 以 避免 由 于 动态 影响 引起 不 必要 的 
误差 。 

这 些 规 则 是 彼此 相关 联 的 轨迹 参数 的 模糊 规则 ， 存 在 一 定 程度 的 不 确定 性 。 
在 下 文中 ， 将 上 述 条 件 转换 成 足 端 轨迹 长 度 、 所 需 的 平均 速度 以 及 足 是 否 向 上 或 
向 下 移动 ， 并 作为 输入 变量 的 模糊 规则 来 推断 适当 的 足 端 加 速度 。 
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7.3.2 模糊 集 和 规则 


通过 使 用 简单 的 Mamdani 模糊 推理 系统 (Mamdani，1981) 攻克 了 给 定 足 
端 轨 迹 找到 最 佳 加 速度 值 的 问题 。 用 3 个 输入 语言 变量 定义 足迹 ， 分 别 为 期 望 的 
平均 足 端 速度 ww、 从 初始 位 置 到 最 终 位 置 的 距离 以 及 = 相对 增 量 Azas BIF 
给 定 轨迹 的 = 增 量 与 行进 距离 之 间 的 比率 ， 即 
(a(t) mz | | 


Az ret 


模糊 推理 系统 的 输出 变量 是 足 部 加 速度 ， 以 此 生成 足 端 速度 和 足 端 轨 迹 。 输 
入 和 输出 模糊 变量 由 模糊 集合 表示 (例如 ， 距 离 为 BIG， 或 足 端 速度 为 
SMALL)， 并 且 每 个 变量 对 于 模糊 集合 的 隶属 度 由 隶属 函数 给 出 [用 于 变量 x 
的 w(Cz)]。 每 个 语言 变量 选择 这 些 隶 属 函 数 的 形状 ， 以 三 角形 或 梯形 速度 分 布 调 
整 速 度 、 距 离 和 加 速度 之 间 的 关系 ， 使 加 速度 与 距离 成 反比 ， 与 速度 的 平方 成 正 
比 ， 即 


(7. 8) 


5 


Um 


a=K (7. 9) 


其 中 K 是 每 个 轮廓 的 常数 值 : 对 于 三 角形 速度 分 布 ，K 二 4， 对 于 梯形 速度 
分 布 ， 开 二 4。 遵 循 模糊 控制 器 设计 指南 (Matia 等 ，1992)， 他 们 声明 推理 图 形 
状 与 输入 变量 隶属 函数 的 形状 相 匹 配 ， 前 提 是 隶属 函数 正常 ， 对 称 且 成 对 重 释 ， 
并 且 在 输出 变量 上 定义 的 隶属 函数 具有 相同 的 面积 。 考 虑 到 这 一 点 ， 为 了 设计 模 
糊 系 统 ， 做 出 以 下 假设 : 

C1) 假设 轨迹 中 的 相对 z 增 量 Axu 由 两 个 模糊 集 (SMALL, BIG) 表示 。 
该 输入 变量 的 成 员 函 数 是 梯形 的 ， 如 图 7. 10 (a) 所 示 。 其 中 横 坐 标 是 相对 z 增 
HE, MER y Aza) ERRE. ER (7.9) P, Aza fla 之 间 的 关系 需要 沿 
着 变量 的 负 斜 率 ， 在 下 一 小 节 中 将 通过 模糊 规则 来 表达 。 

(2) 轨迹 距离 也 由 两 个 模糊 集 (SMALL, BIG} 表示 。 两 个 梯形 距离 隶属 
函数 如 图 7. 10 (b) 所 示 。 其 中 横 坐标 是 轨迹 距离 的 值 ， 纵 坐标 w(s) 是 隶属 度 。 
它们 的 极限 值 通过 SILO4 腿 部 工作 空间 实验 获得 ， 其 中 轨迹 的 最 大 直线 距离 
为 0. 7m。 

(3) 平均 足 端 速度 ww 也 由 两 个 模糊 集合 表示 为 两 个 变量 (SMALL, BIG}, 
隶属 函数 为 了 适应 式 (7.9) 中 的 关系 ， 采 用 抛物 线 而 不 是 梯形 [图 7.10 (c)]。 
它们 的 极限 值 由 SILO4 腿 部 实验 得 到 。 由 于 最 大 电机 转速 为 0. 4m/s， 平 均 足 端 速 
度 限 制 在 0. 2m/s。 足 端 速度 0. 2m/s 可 以 认为 是 直线 运动 的 中 间 值 [图 7. 10 C]. 

(4) 该 模糊 推理 系统 的 输出 是 足 端 加 速度 a， 由 4 个 模糊 集 SMALL, 
MEDIUM - SMALL, MEDIUM - BIG, BIG) 表示 ,隶属 函数 如 图 7.10 (d) 
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图 7.10 模糊 推理 系统 输入 和 输出 变量 的 隶属 函数 


所 示 。 这 些 隶 属 函 数 是 三 角形 的 ， 极 限 值 通过 SILO4 腿 示例 实验 获得 。 

模糊 推理 机 制 基于 以 下 5 个 规则 ， 其 代表 了 足 端 加 速度 对 足 端 速度 、 轨 迹 距 
离 和 相对 = 增 量 的 模糊 依赖 性 。 

1) WẸ vn 为 SMALL，* 为 SMALL，Azu 为 SMALL， 则 an X MEDIUM - 
BIG 。 

2) 如 果 um A SMALL, sX BIG, Aza SMALL, W a SMALL, 

3) WẸ vn X BIG, s X SMALL, Az X SMALL, Jil a BIG, 

4) 如 果 mw 8 BIG, s A BIG, Az SMALL, Mja X MEDIUM - BIG, 

5) 如 果 Aza W BIG, Wa X MEDIUM - BIG, 


7.3.3 模糊 推理 图 


Matlab 及 其 模糊 工具 箱 用 于 解决 模糊 问题 ， 其 中 min 表示 方法 和 含义 ， 
max 表示 聚合 ，centroid 用 于 模糊 化 。 为 了 清楚 起 见 ， 用 于 足 端 加 速度 问题 的 推 
理 图 是 由 3 个 二 维 推理 图 表示 的 超 曲面 。 图 7.11 显示 足 端 加 速度 是 移动 距离 和 
平均 足 端 速度 的 函数 ， 任 何 轨迹 在 足 的 轨迹 上 几乎 没有 xz 分 量 ， 即 相对 z 的 增 量 
非常 接近 零 。 图 7. 12 所 示 为 任何 x 增 量 在 足 端 加 速度 上 的 限制 作用 。 图 7. 12 
Ca) 为 当 平均 足 端 速度 固定 在 0. 200m/s 时 ， 作 为 相对 z 增 量 和 移动 距离 的 函数 
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图 7.11 Aza =O 时 足 端 加 速度 、 轨 迹 距 离 和 
平均 足 端 速度 的 推理 图 
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图 7.12 足 端 加 速度 与 相对 = 增 量 的 推理 图 
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第 7 章 提高 腿 部 速度 的 软 计 算 


的 足 端 加 速度 输出 ; 图 7.12 (b) 显示 了 对 于 0. 350m 行进 距离 的 加 速度 、 相 对 
z 增 量 和 平均 足 端 速度 。 一 旦 获得 足 端 加 速度 函数 ， 就 可 以 使 用 模糊 推理 过 程 的 
实时 优化 方法 (Matia 和 Jimenez，1996) 。 为 了 解决 速度 改善 问题 ， 对 足 部 行为 
施加 的 模糊 规则 的 数量 可 以 根据 动态 复杂 度 进行 修改 ， 这 些 数量 独立 于 机 器 人 腿 
部 的 自由 度数 。 


7.4 实验 结果 


通过 不 同 的 实验 验证 了 调整 足 端 加 速度 在 线 轨迹 生成 的 优越 性 。 为 此 ,采用 
SILO4 腿 作 为 研究 对 象 。 第 一 个 实验 显示 了 执行 几 个 不 同 长 度 的 直线 轨迹 时 足 
端 加 速度 调节 的 效果 。 图 7. 13 说 明了 这 个 实验 ,描绘 了 不 同 轨迹 距离 的 最 大 可 
实现 的 平均 足 端 速度 。 每 个 轨迹 平行 于 腿 的 zx HH, yi 二 0.215m,， zi 二 一 0.250pm。 
图 7.13 中 的 每 条 细 曲 线 表示 没有 动力 学 扰动 运动 时 ， 用 恒定 加 速度 的 足 端 速度 
曲线 可 达到 的 最 大 平均 足 端 速度 ， 实 线 表示 在 相同 轨迹 下 考虑 腿 的 动力 学 时 使 用 
足 端 加 速度 调整 方式 最 大 可 实现 的 足 端 速度 。 如 果 使 用 最 大 恒定 加 速度 曲线 ， 腿 
部 运动 的 动力 效应 将 阻止 腿 部 按 指定 路 径 运动 (图 7.13 中 的 虚线 )， 并 且 在 线 轨 
迹 生 成 期 间 将 出 现 振荡 和 不 期 望 的 效果 。 为 了 确保 动力 效应 不 会 扰乱 和 运动， 应 选 
择 保 守 的 加 速度 值 〈 即 0. 6m/s*)， 并 且 由 于 腿 部 动力 和 了 驱动 器 限制 ,不 能 阻止 
实现 更 高 速度 的 距离 执行 低速 轨迹 。 图 7. 13 清楚 地 显示 了 足 端 加 速度 调整 对 这 
个 问题 的 改进 。 使 用 该 方法 可 实现 的 最 大 加 速度 ， 非 常 接近 驱动 速度 限制 曲线 


350 


a=1.2 


最 大 平均 足 端 速度 / (10-3 m) 


50 L | ll | | j- 1 | | | f | 
100 150 200 250 300 350 400 450 500 550 600 650 700 
轨迹 距离 /(10 my) 


图 ,7.13 具有 恒定 足 加 速度 曲线 和 足 加 速度 调整 的 
最 大 平均 足 端 速度 和 轨迹 距离 曲线 
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(点 划 线 ) ， 避 免 了 不 需要 的 动态 影响 。 

从 图 7.13 中 还 可 以 观察 到 另 一 个 重要 特征 。 使 用 加 速度 调整 方法 实现 的 最 
大 平均 足 端 速度 曲线 ， 对 于 大 距离 轨迹 Cs >0. 35m) 几乎 是 恒定 的 。 如 果 这 个 
步行 机 器 人 控制 系统 总 是 设法 走 大 距离 轨迹 ， 则 可 实现 机 器 人 的 最 高 速度 ， 而 与 
轨迹 距离 无 关 。 使 用 具有 恒定 加 速度 的 速度 曲线 是 不 可 能 的 ， 其 中 最 大 平均 足 端 
速度 随 着 轨迹 距离 而 变化 。 第 一 个 实验 的 结论 是 ， 通 过 调整 足 端 加 速度 找到 可 实 
现 更 高 足 端 速度 的 加 速度 值 ， 又 避免 使 用 可 能 产生 振荡 的 高 加 速度 值 。 这 有 助 于 
使 最 大 平均 足 端 速度 保持 恒定 值 。 

第 二 个 实验 是 足 端 高 速 抬 起 。 由 于 将 第 五 个 模糊 规则 应 用 于 Az (图 
7. 12) ， 足 端 加 速度 调整 方法 将 加 速度 值 限 制 为 提升 足 时 的 0. 6m/s*。 因 此 ,使 
用 中 等 加 速度 值 可 避免 由 在 线 轨迹 生成 时 腿 部 动态 影响 引起 的 振荡 。 没 有 加 速度 
调节 时 ， 主 要 由 腿 部 重量 引起 的 轨迹 跟踪 误差 ， 足 端 加 速度 值 大 于 0. 6m/s 时 
在 足 端 抬升 期 间 腿 产生 振荡 。 图 7.14 (a) 显示 了 3 个 关节 角速度 分 布 图 ， 图 
7.14 (b) 显示 了 足 端 速度 曲线 ， 足 端 以 0.09mys 的 速度 、1lmys? 的 足 端 加 速度 
提升 。 腿 部 关节 3 的 角速度 在 加 速 时 间 内 达到 其 可 达到 的 最 大 值 〈 驱 动 限 制 )， 
导致 在 线 轨迹 跟踪 的 错误 ， 使 腿 振 荡 。 
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图 7.14 足 端 抬升 实验 中 足 端 加 速度 二 1m/s :时 足 端 的 振动 


第 三 个 实验 通过 覆盖 腿 部 工作 空间 的 各 种 轨迹 来 研究 加 速度 调整 的 可 行 性 。 
图 7.15 列 出 了 不 同 轨 迹 距 离 s(t) 和 不 同 腿 部 延伸 距离 RO) 的 轨迹 ， 分 别 由 有 
加 速度 调整 的 足 端 和 恒定 加 速度 的 足 端 执行 可 实现 的 最 大 足 端 速度 〈 分 别 为 粗 线 
和 细 线 )。 每 个 轨迹 都 限于 平面 zx 一 一 0.300m。 不 同 = 分 量 平面 内 的 行为 是 相似 
的 。 图 7.15 实验 中 每 个 轨迹 的 平均 足 端 速度 值 、 移 动 距离 和 最 小 延伸 半径 R(1) 
值 见 表 7. 1。 加 速度 调整 算法 提供 的 改善 对 于 短 轨迹 〈* 近 0. 350m) 更 加 明显 ， 
对 于 较 长 的 轨迹 也 是 可 接受 的 。 如 式 (7.5) 所 述 ， 对 于 具有 和 较 高 RGD 的 相同 
KE bo] 的 轨迹 ， 改 善 更 加 明显 。 从 图 7. 15 可 以 看 出 ， 具 有 加 速度 调整 的 
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图 7.15 加 速度 调整 ( 粗 线 ) 和 0. 6m/s GH) 恒定 加 速度 的 足 端 速度 分 布 
腿 部 行为 ， 对 于 所 有 轨迹 来 说 振荡 较 小 ， 因 为 可 以 实现 高 平均 速度 值 而 不 达到 了 驱 
动 限制 并 避免 动态 效应 ， 而 且 可 以 实现 更 高 的 平均 足 端 速度 。 从 表 7.1 可 知 ， 对 
比 不 使 用 加 速度 调整 时 ， 使 用 加 速度 调整 方法 将 平均 足 端 速度 的 最 大 可 实现 速度 
提高 27%~~100%。 可 以 得 出 以 下 结论 ， 用 于 在 线 轨 迹 生 成 的 足 端 加 速度 调整 方 
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法 是 实现 精确 平滑 和 快速 的 足 端 运动 非常 合适 的 方法 。 本 章 的 所 有 实验 都 显示 了 
在 线 生 成 足 端 直线 轨迹 。 在 50MHz 的 486 处 理 器 上 ， 在 4ms 的 采样 周期 内 实现 
了 在 线路 径 规划 计算 ， 而 模糊 足 端 加 速度 调整 计算 需要 0. 5ms 的 处 理 时 间 ， 确 
保 了 所 提出 的 加 速度 调整 算法 在 步行 机 器 人 运动 中 的 实时 应 用 。 


表 7.1 最 大 可 达到 的 平均 足 端 速度 比较 


min, <<, {R(t)} € Vmmax/ (1073m s71} we 
s/(10~*m) 改进 /% 
/(10-3m) | 加 速度 调整 | a=0. 6m/s? 
120 330 230 180 ated 
150 500 290 220 31.8 
200 580 310 250 24.0 
300 510 340 270 25. 9 
350 400 340 240 41.6 i 
400 200 320 160 100. 0 


7.5 结论 


本 章 的 介绍 重点 是 提高 步行 机 器 人 在 线 轨迹 生成 中 的 腿 部 速度 。 考 虑 了 两 种 
不 同 的 技术 ， 即 最 小 时 间 控 制 算 法 和 足 端 加 速度 调整 方法 。 但 在 线 轨 迹 生 成 的 要 
求 使 得 最 小 时 间 控 制 算法 并 不 合适 ， 因 此 选择 了 加 速度 调整 方法 。 使 用 SILO4 
机 器 人 进行 了 几 项 实验 ， 以 研究 如 何 增加 平均 足 端 速度 。 本 章 详 细 说 明了 这 些 实 
验 ， 并 彻底 解释 了 相关 现象 。 加 速度 调整 方法 将 速度 曲线 的 加 速度 调整 为 适当 的 
幅度 。 为 了 避免 机 器 人 参数 不 确定 性 引起 的 问题 ， 采 用 模糊 算法 。 为 此 ， 基 于 实 
验 定义 的 模糊 规则 ， 找 到 每 个 给 定 轨迹 最 合适 的 加 速度 。 一 个 简单 的 Mamdani 
模糊 推理 系统 用 于 计算 所 需 的 加 速度 。 它 是 基于 使 用 3 个 语言 变量 的 5 个 规则 。 
对 足 端 行为 施加 的 模糊 规则 的 数量 可 以 根据 动态 复杂 度 进行 修改 ， 与 机 器 人 腿 部 
的 自由 度数 量 无 关 。 

已 经 进行 了 一 些 实验 来 验证 算法 。 这 些 实验 得 出 下 列 结论 : 足 端 加 速度 调整 
方法 能 提供 快速 和 平滑 的 足 端 轨迹 的 加 速度 值 ， 避 免 由 于 致 动 器 的 饱和 和 腿 部 动 
力 效 应 引起 的 扰动 效应 。 最 后 进行 了 一 些 实验 以 比较 执行 相同 轨迹 时 使 用 和 不 使 
用 加 速度 调整 方法 的 腿 部 行为 。 该 比较 研究 表明 ， 根 据 移动 距离 ， 相 比 不 使 用 加 速度 
调整 方法 时 ， 加 速度 调整 方法 提高 了 平均 足 端 速度 ， 提 高 幅度 达到 27% ~100% . 
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PESE 步行 机 器 人 的 虚拟 传感器 


8.1 简介 


步行 机 器 人 的 主要 优点 之 一 是 它们 对 不 规则 、 非 结构 化 地 形 的 适应 性 很 强 。 
但 这 些 机 器 人 的 控制 算法 、 机 械 和 电子 硬件 的 复杂 性 是 对 其 适应 性 的 严重 制约 因 
素 。 如 第 1 章 所 述 ， 这 种 复杂 性 是 步行 机 器 扩展 到 实际 应 用 的 主要 障碍 之 一 。 

地 形 适 应 需要 的 一 个 重要 信息 是 在 腿 部 摆动 结束 时 检测 足 与 地 形 之 间 的 接触 
(地 面 检测 ) 。 在 穿越 高 度 不 规则 的 地 形 时 ， 腿 部 摆动 期 间 ， 腿 部 和 障碍 物 之 间 的 
碰撞 也 必需 检测 。 此 外 为 了 增强 足 的 运动 性 能 ， 改 善 足 部 牵引 力 并 优化 重量 分 
布 ， 在 支撑 相 期 间 需 对 足 力 监 测 。 传 统 上 ， 通 过 使 用 安装 在 机 器 人 足 部 的 不 同 种 
类 的 传感器 来 实现 监测 需求 。 随 着 步行 机 器 人 的 发 展 ， 出 现 了 诸如 开关 Jimenez 
等 ，1993) 、 和 触须 传感器 (Hirose 等 ，1990) 、 应 变 计 (Schneider 和 Schmucker, 
2000; Rossmann 和 Pfeiffer，1998) 、 载 荷 单元 (Gonzalez de Santos #, 2003), 
弹簧 电位 计 CRiddestrom 等 ，2000) 和 电感 式 传感器 (Grieco 等 ，1998) 等 
设备 。 

然而 ， 这 些 解 决 方案 存在 诸如 增加 机 顺 复 杂 性 、 降 低 鲁 棒 性 等 缺点 。 在 机 顺 
人 足 端 处 安装 电子 设备 需要 接线 ， 且 传感器 将 持续 暴露 在 外 面 ， 与 不 同 种 类 的 地 
形 和 障碍 物 相互 作用 。 在 沙 质 、 潮 湿 或 磨 蚀 性 地 形 上 运动 易 造 成 检测 过 程 中 的 故 
障 以 及 传感器 系统 的 损坏 ， 是 故障 的 重要 来 源 。 此 外 ， 这 种 附加 的 硬件 增加 了 机 
器 人 的 总 价格 以 及 维护 成 本 。 

机 器 人 足 部 安装 传感器 的 替代 方案 是 利用 伺服 电机 系统 中 的 信号 。 例 如 ， 为 
了 估计 用 于 适应 地 面 的 关节 转 和 矩 ,， 通常 监测 电机 电流 (Kepplin 和 Berns, 
1999)。 也 可 以 使 用 其 他 信息 来 实现 对 环境 的 感知 。 关 节 位 置 传感器 提供 的 信息 
就 可 以 用 于 此 目的 ， 见 8.2 节 。 

此 外 ， 特 定 的 传感器 只 能 部 分 表征 机 器 或 其 环境 的 内 部 状态 。 信 息 来 源 相互 
关联 ， 可 以 为 步行 机 器 提供 固有 的 感知 信息 元 余 ， 而 不 增加 其 硬件 。 这 种 宛 余 可 
以 防止 剧烈 的 系统 故障 ， 并 产生 更 准确 、 一 致 的 感知 信息 ， 以 确定 步行 机 器 在 非 
结构 化 地 形 中 的 行为 。 最 近 的 一 些 研 究 (Kepplin 和 Berns, 1999; Luo 等 ， 
2001; Shimizu 等 ，2002) 给 出 了 在 步行 机 领域 传感器 系统 融合 中 的 成 果 。 
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本 章 讨论 虚拟 传感器 的 设计 、 开 发 和 测试 。 可 以 将 其 定义 为 通过 监测 其 他 可 
用 量 值 来 推测 、 感 知 信息 大 小 的 系统 。 目 的 是 替代 或 补充 物理 传感器 通常 给 出 的 
地 形 信息 ， 简 化 步行 机 器 人 的 硬件 ， 降 低 设 计 、 施 工 和 维护 成 本 ， 同 时 增强 机 器 
的 鲁 棒 性 及 其 行为 的 可 靠 性 。 这 些 虚拟 传感器 基于 神经 网 络 ， 可 以 估计 出 从 机 器 
人 关节 位 置 传感器 中 提取 的 由 足 端 施加 的 力 。 这 些 估计 可 以 模拟 由 开关 、 安 装 在 
足 上 的 单 轴 力 传感器 或 三 轴 力 传感器 给 出 的 信息 。 在 腿 部 摆动 结束 时 ， 采 用 力 佑 
计 来 检测 足 与 地 面 之 间 的 接触 。 


8.2 方法 概述 


如 8. 1 节 所 述 ， 通 过 监测 和 处 理 机 器 人 的 伺服 控制 系统 中 可 用 的 某 些 信息 ， 
可 以 获取 关于 地 形 的 传 感 信息 。 此 处 ， 建 议 采用 机 器 人 系统 可 用 的 关节 位 置 传 感 
器 提供 的 信息 ， 以 估计 由 足 端 施加 的 力 。 这 种 分 析 的 直接 目标 是 检测 腿 部 和 足 底 
之 间 的 接触 ， 也 可 以 用 于 运动 时 其 他 目标 的 检测 ， 例 如 检测 腿 部 损坏 及 重量 分 
布 ， 甚 至 只 是 在 操纵 任务 中 校准 程序 准确 适应 各 种 情况 。 

从 关节 位 置 传感器 可 以 得 出 的 最 主要 信息 是 关节 位 置 误差 ， 定 义 为 由 轨迹 发 
生 器 给 出 的 关节 的 期 望 位 置 和 由 关节 位 置 传感器 给 出 的 实际 位 置 之 间 的 差 。 但 大 
多 数 的 伺服 控制 系统 可 以 正确 解释 这 个 信号 、 估 算出 关节 转 矩 ， 从 而 得 出 足 力 。 
最 初 监测 位 置 传感器 的 位 移 可 以 用 来 关闭 控制 回路 ， 以 提取 关于 环境 的 信息 。 但 
由 于 现在 可 用 信息 较 多 ， 可 以 省 略 安装 在 腿 部 中 的 传感器 和 相关 硬件 ， 简 化 步行 
机 器 ， 并 改善 对 环境 的 感知 。 例 如 ， 不 仅 可 以 估计 由 足 施 加 的 力 ， 而 且 可 以 估计 
通过 腿 结构 的 任何 部 分 施加 的 力 ， 用 于 在 腿 部 移动 期 间 检测 意外 的 碰撞 。 因 此 ， 
该 估计 是 对 安装 在 足 上 的 力 传 感 器 提供 的 信息 的 补充 。 

为 了 确定 该 方法 的 可 行 性 ， 用 步行 机 器 人 进行 了 一 些 初步 实验 (参见 8.5 
节 )。 这 些 实验 中 ， 机 器 人 的 一 个 足 沿 地 面 移动 ， 采 集 腿 的 所 有 3 个 关节 的 位 置 
误差 。 图 8. 1 (a) 描述 了 腿 在 空中 自由 移动 时 的 位 置 误差 ; 图 8. 1 b) 表示 在 
相同 条 件 下 是 与 地 面 磁 撞 (T~2s) 时 关节 位 置 误差 的 变化 。 在 这 种 情况 下 ,位 
置 误差 的 明显 上 升 表明 了 足 与 地 面 接触 检测 以 及 进行 是 力 估 计 的 可 行 性 。 

然而 ， 关 节 位 置 误差 和 足 力 之 间 的 关系 非常 复杂 ， 它 取决 于 多 种 因素 。 

d) 这 种 关系 主要 取决 于 腿 部 运动 的 某 些 变 量 。 首 先 ， 关节 位 置 误差 严重 依 
赖 于 内 部 关节 速度 。 这 种 依赖 主要 是 由 减速 齿轮 和 变速 器 引起 的 摩擦 效应 ， 这 是 
一 个 相当 复杂 的 现象 (Garcia 等 ，2002) 。 当 足 自 由 移动 时 ， 仅 由 摩擦 引起 的 位 
置 误差 是 显著 的 ， 并 且 与 足 撞击 地 面 时 测量 的 位 置 误差 大 小 相当 。 其 次 ,位 置 误 
差 也 取决 于 足 的 位 置 ， 这 种 依赖 性 主要 由 重力 影响 和 足 力 通过 腿 部 运动 学 转化 为 
关节 转 矩 给 出 ， 两 个 因素 在 数学 上 容易 建 模 。 但 是 也 可 能 存在 位 置 相 关 的 摩 控 效 
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(a) 腿 部 在 空中 自由 移动 Cb) 足 与 地 面相 挤 

图 8. 1 腿 部 运动 期 间 关 节 位 置 误差 的 演变 示例 


Di (Garcia 等 ，2002)， 这 是 由 传动 磨损 、 轴 不 对 准 等 引起 的 复杂 现象 。 最 后 ， 
位 置 误差 取决 于 关节 加 速度 。 在 电机 加 速 期 间 ， 关 节 位 置 误差 取决 于 控制 器 跟踪 
速度 曲线 的 能 力 。 摩 擦 力也 受 关节 速度 变化 的 影响 ; 关节 速度 的 增加 可 以 产生 比 
降低 速度 更 高 的 摩擦 力 ， 并 且 随 着 速度 变化 越 来 越 快 ， 滞 回 曲线 变 宽 。 

(2) 位 置 误差 也 取决 于 被 认为 是 可 能 恒定 的 因素 ， 尽 管 它们 可 能 随时 间 而 变 
化 。 诸 如 磨损 和 维护 ， 温 度 ， 由 于 电池 耗 尽 引起 的 电气 特征 的 变化 以 及 运动 控制 
器 的 参数 改变 而 导致 的 机 械 性 能 变化 。 

(3) 位 置 误差 取决 于 其 他 因素 。 位置 误差 的 大 小 取决 于 其 控制 规律 并 不 总 是 
已 知 运动 控制 器 和 功率 驱动 器 的 特性 、 使 用 的 传动 和 减速 器 (蜗轮 ， 齿轮 ， 螺 
杆 ， 皮 带 ， 谐 波 驱 动 器 等 )、 电 源 供应 特性 等 。 

综 上 所 述 ， 足 力 与 关节 位 置 误差 的 关系 取决 于 许多 因素 ， 由 复杂 的 模式 决 
定 。 为 了 获得 足 力 的 估计 系统 ， 有 必要 开发 一 种 识别 这 些 效应 的 模型 ， 使 未 知 量 
值 与 可 用 量 值 相 关 。 这 个 想法 与 虚拟 传感器 的 定义 相 匹配 ， 一 种 技术 在 近 几 年 已 
经 变 得 越 来 越 流行 ， 即 基于 神经 网 络 的 虚拟 传感器 技术 。 


8.3 ”基于 神经 网 络 的 虚拟 传感器 


虚拟 传感器 ， 也 称 为 软件 传感器 或 估计 器 ， 是 通过 分 析 可 用 的 相关 传 感 数据 
间接 测量 所 需 传 感 信息 的 方法 。 当 物理 传感器 由 于 价格 、 尺 寸 、 重 量 、 技 术 缺 陷 
而 提供 的 测量 不 可 行 时 (Wickstrom 等 ，1997; Masson 等 ，1999) ， 或 者 没有 特 
定 的 物理 传感器 可 用 时 (Valentin 和 Denoeux, 2001; Leal 等 ，1997)， 常 使 用 
虚拟 传感器 作为 物理 传感器 的 替代 品 。 此 外 ， 虚 拟 传感器 构建 了 许多 容错 系统 、 
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部 分 “控制 技术 
故障 检测 系统 和 传 感 信 息 融 合 系统 。 虚 拟 传 感 器 的 一 个 重要 特征 是 它们 本 质 上 是 
鲁 棒 的 ， 这 是 因为 它们 具有 固有 的 元 余 特 征 ， 其 结果 是 考虑 不 同 相互 关联 的 传 感 
信息 ， 而 不 使 用 附加 硬件 。 

数据 驱动 〈 经 验 ) 虚拟 传感器 (Masson 等 ，1999) 从 具有 代表 性 操作 示例 
的 训练 集合 中 ， 统 计 估 计 已 知 和 未 知 传 感 信息 之 间 的 相关 性 。 当 系统 的 分 析 模 型 
未 知 以 及 模型 开发 成 本 需要 降低 时 ， 可 使 用 这 种 虚拟 传感器 (Hanzevack $, 
1997)。 数 据 驱 动 虚拟 传感器 的 实现 经 常 基于 人 工 神经 网 络 (Ablameyko 等 ， 
2003) 。 神 经 网 络 的 主要 优点 是 能 够 建立 高 度 复杂 、 非 线性 、 多 维 、 动 态 和 自 适 
应 输入 和 输出 量 之 间 的 关联 。 基 于 神经 网 络 的 虚拟 传感器 特别 适用 于 实现 系统 的 
传感器 融合 (Leal 等 ，1997) 、 数 据 验 证 和 故障 检测 (Hines 等 ，1998) 、 系 统 和 
不 完整 的 传 感 信息 重建 (Valentin 和 Denoeux, 2001) 等 。 神 经 网 络 还 有 自主 在 
线 学 习 的 可 行 性 ， 这 人 允许 构建 适应 性 模型 (Hanzevack 等 ，1997)， 并 预测 未 知 
量 (Yuan 和 Vanrollehghem,. 1998). 

基于 神经 网 络 的 虚拟 传感器 的 主要 缺点 是 ， 只 有 在 训练 区 域 中 包含 的 工 况 下 
它们 才 是 可 靠 的 ， 因 此 必须 对 具有 代表 性 的 样本 进行 仔细 训练 ， 以 准确 地 描述 在 
实践 中 可 能 遇 到 的 所 有 工 况 。 此 外 ， 神 经 网 络 模型 需要 比 物 理 模 型 更 细致 的 验 
证 。 最 后 ， 虚 拟 传 感 器 需要 一 个 处 理 系统 ， 如 计算 机 、 微 控制 器 或 FPGA 来 完 
成 其 估计 过 程 。 


8.4 虚拟 传感器 设计 


8. 2 节 指 出 了 为 估计 足 力 整个 机 电 系统 中 位 置 误差 模型 的 必要 性 。 这 里 提出 
使 用 神经 网 络 来 将 足 力 与 可 用 的 传 感 信息 相关 联 ， 从 而 实现 虚拟 传感器 。 神 经 网 
络 的 一 般 优点 见 8. 3 节 ， 在 这 个 特定 的 应 用 程序 中 还 呈现 出 有 趣 的 特性 。 

如 前 所 述 ， 神 经 黑 盒 建 模 不 需要 数学 模型 ， 这 使 得 该 技术 很 容易 扩展 到 其 他 
伺服 控制 系统 ， 使 虚拟 传感器 能 适应 不 同 的 步行 机 器 人 人。 此外， 整个 系统 的 行为 
可 以 通过 与 常规 行走 相似 的 一 个 步 幅 建 模 ， 加 速 校准 过 程 ， 并 简化 所 需 的 实验 设 
置 (参见 8. 5. 2 节 )。 虽 然 神 经 网 络 建 模 减少 了 所 需 的 关于 系统 的 先 验 知识 ， 但 
仍 需 要 选择 合适 的 网 络 架构 来 正确 地 对 系统 进行 建 模 ， 因 此 在 这 个 意义 上 ， 神 经 
模型 是 灰色 系统 。 此 外 ， 这 些 装置 的 使 用 将 有 助 于 将 来 增加 补充 传 感 信息 源 ， 整 
合 安装 在 机 器 人 的 足 上 的 物理 传感器 数据 〈 力 传感器 、 开 关 等 ) 和 其 他 估计 数据 
(电动 机 电流 )。 最 后 ， 大 多 数 步行 机 器 人 都 具有 能 够 计算 估计 值 的 计算 系统 ， 所 
以 虚拟 传感器 的 实现 不 会 导致 硬件 的 增加 。 

影响 关节 位 置 误差 的 因素 在 8. 2 节 已 经 描述 ， 本 节 仅 具体 考虑 关节 位 置 和 速 
度 。 如 上 所 述 ， 关 节 位 置 和 速度 是 确定 腿 部 运动 期 间 系统 工作 状态 的 主要 运动 变 
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量 。 因 此 ， 将 其 与 关节 位 置 误差 一 起 作为 神经 网 络 的 输入 ， 并 计 及 黏 性 摩擦 、 位 
置 相关 的 摩擦 效应 、 腿 部 运动 学 、 重 力 等 变量 建 模 。 将 关节 加 速度 作为 神经 网 络 
输入 ,证 明 其 不 能 提高 本 虚拟 传感器 的 性 能 (8.5 节 )。 在 使 用 虚拟 传感器 时 ， 
仅 在 启动 停止 条 件 下 〈 即 高 加 速度 时 〉 观察 到 与 关节 转动 惯量 相关 的 动态 影响 ， 
在 腿 摆 动 末期 并 未 发 现 关 节 转 动 惯 量 的 影响 。 类 似 地 ， 在 这 个 系统 中 诸如 动态 摩 
擦 滞后 的 影响 并 不 显著 。 影 响 估 计 的 其 他 因素 (8. 2 节 ) 作为 常数 ， 在 虚拟 传 感 
器 的 一 般 设 计 中 考虑 。 不 同 的 机 器 存在 不 同 的 效应 ， 这 也 是 使 用 通用 GR) 方 
法 对 其 进行 建 模 的 原因 ， 即 有 助 于 适应 不 同 的 伺服 控制 系统 。 

在 这 项 工作 中 已 经 测试 了 3 种 可 能 的 期 望 输出 响应 : 叫 腿 状态 分 为 与 地 形 碰 
撞 和 自由 运动 ; 包 由 足 施 加 的 足 力 的 估计 ; 3 个 足 力 分 量 的 估计 。 

考虑 到 这 3 种 可 能 性 ， 旨 在 从 实验 硬件 要 求 和 所 获得 的 佑 计 的 质量 来 评估 和 
比较 不 同 级 别 的 信息 输出 质量 。 

上 述 虚 拟 传 感 器 的 一 些 变型 已 经 在 初步 实验 中 进行 了 测试 ， 以 分 析 关 节 位 置 
输入 对 估计 的 影响 。 在 这 些 改进 的 虚拟 传感器 中 ， 通 过 训练 神经 网 络 估计 3 个 关 
节 转 德 。 通 过 对 腿 动 力学 模型 的 分 析 (第 6 章 )， 计 算 从 足 力 到 关节 转 矩 的 转换 
(反之 亦 然 ) 。 假 设 在 该 模型 中 考虑 了 所 有 与 位 置 相关 的 影响 ， 因 此 位 置信 号 不 包 
括 在 网 络 的 输入 中 。 使 用 该 改进 的 虚拟 传感器 进行 实验 ， 其 结果 比 初始 设计 更 
差 。 这 个 事实 表明 ， 还 存在 其 他 不 包括 在 动态 模型 中 的 位 置 相关 效应 ， 这 可 能 与 
传动 系统 中 的 摩擦 和 传动 轴 错 位 有 关 。 在 这 种 改进 的 设计 中 包括 关节 位 置信 号 作 
为 网 络 输入 ， 导 致 传感器 性 能 与 原始 虚拟 传感器 的 性 能 类 似 。 因 此 ， 可 以 得 出 以 
下 结论 : 

d) 位 置 作为 网 络 输 入 ， 对 于 不 能 辨识 的 位 置 相关 的 效应 进行 建 模 是 必要 
的 ， 它 们 大 大 提高 了 估计 的 质量 。 

(2) 位 置 影响 相关 的 分 析 模 型 并 没有 提高 虚拟 传感器 的 性 能 。 因 此 ， 这 些 变 
型 被 舍弃 。 


8.5 在 真实 步行 机 器 中 使 用 虚拟 传感器 


8.4 节 提出 的 虚拟 传感器 设计 适用 于 任何 类 型 的 机 器 人 ，SILO4 四 足 机 器 人 
(附录 A) 已 经 使 用 并 进行 了 初步 实验 ， 其 中 估计 的 有 效 性 已 经 通过 实验 表征 。 
如 附录 A. 2.4 中 ， 将 用 于 校准 虚拟 传感器 的 三 轴 压 电 式 传感器 放置 在 足 部 ， 其 
提供 的 标准 测量 误差 为 2N， 约 为 本 书 考虑 的 力 范 围 的 2% (0 一 100N)。 虚 拟 传 
感 器 实施 和 校准 程序 可 能 变化 ， 但 该 方法 可 以 扩展 到 任何 步行 机 器 人 ， 甚 至 可 以 
扩展 到 具有 相似 特性 的 任何 伺服 控制 系统 。 本 节 以 实验 及 其 结果 为 例 ， 描 述 神经 
网 络 架 构 和 校准 过 程 。 
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8.5.1 神经 网 络 


为 了 解决 地 面 检测 问题 ， 选 择 了 具有 一 个 隐 层 和 sigmoidal 激活 函数 的 非 线 
性 前 馈 神经 网 络 〈 多 层 感 知 器 ) 。 这 种 网 络 架构 在 非 线 性 静态 系统 的 建 模 和 虚拟 
传感器 的 实现 中 得 到 广泛 的 推广 (Valentin 和 Denoeux，2001; Wickstrom 等 ， 
1997; Leal 等 ，1997; Yuan 和 Vanrollehghem, 1998; Masson 等 ，1999)， 

以 前 的 经 验 表 明 ， 关 节 惯 性 或 摩擦 滞后 引起 的 动态 效应 在 SILO4 平台 的 正 
常 运行 范围 内 并 不 显著 。 因 此 ， 使 用 一 些 众所周知 的 动态 网 络 架 构 〈 例 如 具有 反 
馈 的 Elman 网 络 和 多 层 感 知 器 ) 或 将 过 去 的 输入 (延迟 输入 ) 包括 在 静态 网 络 
中 ， 并 不 能 证 明 能 够 增强 系统 的 性 能 。 发 现 静 态 的 前 人 馈 网 络 方法 足以 用 于 该 特定 
平台 系统 建 模 。 

如 8.4 节 所 述 ， 每 个 腿 关 节 的 位 置 误差 、 位 置 和 速度 被 选 为 网 络 的 输入 量 
值 。 腿 部 由 3 个 关节 组 成 ， 因 此 共有 9 个 输入 神经 元 。 隐 藏 神 经 元 的 数量 根据 经 
验 固 定 为 5 个 ， 根 据 结 果 的 质量 和 训练 成 本 进行 选择 。 在 虚拟 开关 和 虚拟 单 轴 力 
传感器 的 情况 下 ， 输 出 神经 元 的 数量 只 有 1 个 ,在 虚拟 三 轴 力 传感器 的 情况 下 为 


8s 
8.5.2 网 络 校准 样本 集 


为 了 校准 虚拟 传感器 ， 神 经 网 络 必须 在 步行 机 器 的 正常 运行 期 间 ， 用 输入 量 
和 期 望 输出 的 示例 进行 训练 。 因 此 ， 这 些 示例 包括 3 个 腿 关 节 的 位 置 、 速 度 和 位 
置 误差 的 一 系列 样本 ， 以 及 用 于 校准 的 三 轴 压 电 式 传感器 的 测量 结果 。 对 于 未 配 
备 力 传感器 的 机 器 人 ， 在 数据 采集 过 程 中 应 安装 临时 校准 传感器 。 根 据 所 需 的 虚 
拟 传感器 响应 ， 该 校准 传感器 可 以 是 开关 、 单 轴 力 传感器 或 三 轴 力 传感器 。 由 于 
虚拟 传感器 的 目的 是 检测 足 / 地 面 接触 ， 所 以 每 个 样本 包含 在 足 向 下 移动 到 地 面 
并 最 终 与 其 碰撞 时 所 采集 的 数据 ， 类 似 于 正常 的 运动 过 程 。 实 验 中 使 用 的 传感器 
采样 频率 为 50Hz。 在 实验 过 程 中 ， 机 器 人 以 与 当前 正在 使 用 的 不 连续 步 态 (第 
3 章 ) 中 姿势 类 似 的 方式 ， 支 撑 在 其 他 3 条 腿 上 。 这 种 方式 所 获得 的 足 力 (其 取 
决 于 机 器 人 的 总 重量 、 腿 的 柔韧 性 、 支 撑 足 的 位 置 等 ) 与 在 正常 条 件 下 的 足 端 力 
相似 。 校 准 流 程 如 图 8. 2 所 示 。 

1. 训练 样本 集 

用 于 训练 网 络 的 样本 必须 准确 地 表示 所 有 可 能 性 ， 且 保持 尽 可 能 少 的 样本 量 
以 加 速 校 准 过 程 。 为 了 界定 问题 ， 足 端 轨迹 被 限制 在 机 器 人 当前 使 用 的 不 连续 步 
态 中 的 轨迹 。 因 此 ， 训 练 样本 中 使 用 垂直 和 直线 轨迹 (Estremera 等 ，2005 ) 。 
然后 选择 训练 实例 来 表示 在 正常 运动 中 发 现 的 所 有 可 能 的 足 的 速度 和 所 有 垂直 轨 
迹 〈 即 所 有 操作 点 ) 。 选 择 垂直 足 端 轨迹 和 速度 值 ， 目 的 是 均匀 地 覆盖 整个 腿 工 
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目标 函数 
f Pes 
f T, f.) E 
x 力 信号 


图 8.2 校准 流程 


作 空 间 和 整个 速度 范围 〈0. 025 一 0. 1m/s)。 用 于 训练 网 络 的 样本 总 数 (结合 这 
些 足 步 速度 和 轨迹 的 结果 ) 为 210 个 ， 总 计 多 达 30000 个 样本 。 

2. 测试 样本 集 

执行 新 实验 以 获得 测试 样本 集 ， 其 设计 为 在 实践 中 可 能 遇 到 的 不 同情 况 下 验 
证 虚拟 传感器 。 因 此 ， 样 本 表示 在 腿 部 工作 空间 内 执行 直线 和 垂直 轨迹 ， 以 及 在 
正常 运动 中 使 用 的 速度 范围 。 侈 弃 其 他 工作 条 件 ， 因 为 它们 在 地 面 检 测 过 程 中 不 
会 出 现 。 该 样本 集 分 为 3 个 子 集 ， 每 个 子 集 旨 在 评估 虚拟 传感器 性 能 的 特定 
方面 。 

d) 测试 集 A。 该 集合 由 在 测试 在 训练 过 程 中 相同 操作 条 件 下 估计 的 准确 
性 。 因 此 ， 其 所 包含 的 样本 与 训练 集中 包含 的 实例 相同 。 

(2) 测试 集 B。 该 集合 用 于 在 单个 工作 点 测试 系统 的 重复 性 。 所 有 的 实例 都 
对 应 于 单个 随机 选择 的 工作 点 。 

(3) 测试 集 C。 该 集合 旨 在 测试 在 训练 过 程 中 未 呈现 出 的 工作 条 件 下 估计 的 
准确 性 。 它 包括 与 训练 集中 的 足 端 速度 和 轨迹 最 相似 的 足 端 速度 和 轨迹 的 样本 ， 
同时 保持 在 本 书 考虑 的 速度 范围 和 腿 部 工作 空间 内 。 


8.5.3 WARE 


在 上 述 实验 中 记录 训练 过 程 中 相关 的 传 感 信息 幅 值 ， 以 产生 适当 的 输出 。 
8.4 节 已 经 测试 了 3 种 可 能 性 。 

1. 虚拟 开关 . 

网 络 输出 将 足 端 状 态 分 为 自由 运动 或 地 面 接触 。 阔 值 力 Fr 被 认为 是 足 碰撞 
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并 牢固 地 放置 在 地 面 上 的 力 的 国 值 ， 用 于 确定 腿 状 态 。 考虑 到 这 一 点 ， 目 标 功能 
输出 被 定义 为 以 下 步骤 . 
0 Wfzt tise 
l 其 他 
AP f.:、f;,、f: 一 一 由 校准 传感器 提供 的 3 个 力 分 量 。 

在 随后 的 训练 过 程 中 ， 考 虑 不 同 的 力 贱 值 产生 目标 函数 ， 以 评估 调节 虚拟 开 
关 灵 敏 度 的 可 行 性 。 

2. 虚拟 单 轴 力 传感器 

网 络 输出 是 模拟 力 的 估计 值 。 因 此 使 用 的 目标 函数 为 

人 

3. 虚拟 三 轴 力 传感器 

具有 3 个 输出 神经 元 的 神经 网 络 被 训练 成 接近 由 校准 力 传感器 提供 的 3 个 信 
号 中 的 每 个 分 量 ， 即 


了 三 


7 

因此 ， 可 以 估计 施加 的 力 的 方向 ， 这 是 估计 足 / 地 面相 互 作用 力 的 最 一 般 
情况 。 

训练 过 程 是 在 Matlab 5. 0 神经 网 络 工 具 箱 (MATLAB，1992) 的 帮助 下 完 
成 的 。 所 选择 的 学 习 算 法 是 基于 训练 时 间 选 择 和 获得 结果 的 精度 的 Levenberg - 
Marquardt 反 向 传播 (Hagan 等 ，1996)。 训 练 200 次 后 ， 均 方 误差 是 稳定 的 ， 
且 进 一 步 的 训练 不 能 显著 改善 结果 。 用 Pentium 800MHz 计算 机 上 在 约 10min 
内 完成 了 训练 过 程 。 


8.5.4 网 络 性 能 测试 


进行 了 测试 地 面 探 测 系统 运行 的 实验 。 在 这 些 实验 中 ， 在 测试 组 中 包括 的 工 
作 条 件 下 当 足 移动 到 地 面 时 ， 计 算 网 络 输出 (8.5.2 节 )。 在 所 有 和 情况 下 ， 计 算 
估计 所 需 的 时 间 均 少 于 lms。 将 网 络 输出 与 从 校准 力 传感器 获得 的 数据 进行 比 
较 ， 以 表征 虚拟 传感器 的 精度 。 本 节 介 绍 了 实验 测试 结果 。 关 于 这 些 结果 的 讨论 
m8. 5.5 F 

1. 虚拟 开关 测试 

虚拟 开关 测试 时 ， 通 过 使 用 接触 力 Fe 来 定义 检测 系统 的 性 能 ， 该 接触 力 被 
定义 为 在 网 络 输出 被 激活 的 瞬间 由 校准 力 传感器 测量 的 力 〈 即 当 网 络 估计 施加 的 
力 超 过 力 靖 值 F+)。 力 阐 值 和 接触 力 之 间 的 差异 是 系统 的 力 误差 FE。 图 8. 3 所 
示 为 在 虚拟 开关 测试 中 足 力 幅 值 的 轨迹 。 已 经 用 几 个 网 络 权重 集 进行 该 测试 〈 在 
不 同 的 训练 过 程 中 获得 )， 对 应 得 到 不 同 的 力 冰 值 。 在 虚拟 开关 测试 中 测量 的 接 
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是 为 /NN 


足 力 (标准 传感器 ) 
| = 


图 8.3 在 虚拟 开关 测试 中 足 力 幅 值 的 轨迹 


触 力 〈 测 试 集 A) 如 图 8.4 所 示 。 图 8.4 中 描述 了 对 于 包括 在 测试 集 A 中 的 不 
同 操作 点 和 多 个 力 浆 值 Fr ， 使 用 误差 条 来 表示 Fc 的 平均 值 和 关于 Fc 平均 值 的 
标准 偏差 ， 以 及 表示 系统 理想 行为 的 直线 。 在 这 些 实验 中 ,针对 不 同 工 作 点 测量 
的 Fr 的 标准 误差 为 4 儿 一 8 兴 ， 其 值 取决 于 Fr。 图 8.5 所 示 为 在 虚拟 开关 测试 
中 测量 的 接触 力 〈 测 试 集 C) ， 标 准 误 差 在 总 力 范围 的 3%% 一 14% 变 化 。 图 8.6 所 
示 为 虚拟 开关 测试 中 测量 的 接触 力 〈 测 试 集 B)， 用 于 表征 虚拟 传感器 重复 性 的 
Fo 平均 值 的 标准 误差 在 力 范 围 的 2% 一 4%， 其 值 取决 于 Fre 


Fe/N 


站 
5 10 15 20 25 30 35 40 45 50 55 60 65 70 75 
Fr/N 


图 8.4 在 虚拟 开关 测试 中 测量 的 接触 力 〈 测 试 集 A) 
2. 虚拟 单 轴 力 传感器 测试 
图 8. 7 以 代表 性 的 示例 说 明了 使 用 虚拟 单 轴 力 传感器 获得 的 估计 的 精度 。 已 
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te | 1 1 L 1 L 1 人 
5 10 15 20 25 30 85 40 45 50 55 60 65 70 75 
Fy/N 


图 8.5 虚拟 开关 测试 中 测量 的 接触 力 〈 测 试 集 C) 


Fe/N 


0 一 


b Ne et SA E Wk NR, ee A 
0 15 20 25 30 35 40 45 50 55 60 65 70 75 
Fr/N 


5 


m 


图 8.6 虚拟 开关 测试 中 测量 的 接触 力 (测试 集 B) 


120 
z 一 一 校准 传感器 测量 的 足 力 
RH 网 络 估计 

80| 一 -一 力 误差 


fawn 
x 
0 nee) ERII w i y WR 


图 8.7 单 轴 力 估计 示例 


经 使 用 估计 的 标准 误差 、 平 均 力 误差 和 确定 系数 (多 个 相关 系数 ) 来 表征 每 个 测 
试 示例 的 估计 准确 度 。 在 所 有 测试 实施 示例 中 ， 估 计 的 标准 误差 低 于 总 测量 范围 
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的 5%， 而 观察 到 的 最 大 力 误差 始终 低 于 该 范围 的 10%。 图 8. 8 显示 了 测试 集 A 
中 包含 的 所 有 示例 的 统计 信息 。 在 所 有 情况 下 , 平均 误差 约 为 2% (ARAN 
IE), 标准 误差 为 2% 一 4%。 图 8. 9 显示 了 测试 集 C 中 所 有 示例 的 统计 信息 。 如 


国 标准 误差 E 平均 误差 


36 41 
示例 序号 
图 8.8 ”测试 集 A 的 示例 中 单 轴 力 估计 的 标准 误差 和 平均 误差 


1 6 11 16 21 26 31 


标准 误差 国 平均 误差 


误差 /N 


1 6 11 16 21 26 
l 示例 序号 


图 8.9 测试 集 C 的 实例 中 单 轴 力 估计 的 标准 误差 和 平均 误差 
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图 8. 9 所 示 ， 平 均 误差 和 标准 误差 与 测试 集 A 计算 出 的 平均 误差 和 标准 误差 非 
常 相似 。 图 8. 10 显示 了 对 于 测试 集 C 中 的 所 有 示例 ， 虚 拟 传 感 器 以 与 虚拟 开关 
相同 的 方式 进行 估计 时 获得 的 结果 。 图 8. 11 表示 确定 系数 对 工作 点 的 依赖 关系 。 


Z 80 
aa 


1 a as ES ee | 
0 5 10 15 20 25 30 35 40 45 50 55 60 65 70 75 
Fy /N 


图 8.10 在 虚拟 单 轴 力 传感器 测试 中 测量 的 接触 力 〈 测 试 集 C) 


确定 系数 R? 


V/(10 3m.s !) 


图 8.11 不 同 轨迹 足 端 速度 的 单 轴 力 估计 的 确定 系数 

3. 虚拟 三 轴 力 传感器 测试 

3 个 足 力 分 量 的 估计 精度 已 经 以 相同 的 方式 进行 了 描述 ， 统 计 了 3 个 网 络 输 
出 中 的 每 一 个 分 量 。 图 8. 12 显示 了 在 典型 的 足 / 地 面 碰撞 示例 中 ， 网 络 估计 如 何 
反映 校准 传感器 测量 的 结果 。A 组 和 C 组 测试 样本 的 估计 质量 相似 ,平均 误差 
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Pare Be aoe ee Bae a TA PS So ea Ee eee 


小 于 2%， 标 准 误差 低 于 所 有 试验 例 中 总 力 范围 的 5%。 图 8.13 显示 了 测试 集 C 
的 这 些 统计 信息 。 
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一 校准 传感器 测量 的 足 力 
| 一 网 络 估计 
80 


足 力 /N 
2 


图 8.12 三 轴 力 估计 示例 


标准 误差 /N 


Wl 
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rn 


1 6 11 16 21 26 
示例 序号 


8.13 ”来自 测试 集 C 的 示例 中 三 轴 力 估计 的 标准 误差 


4. 不 规则 地 形 的 运动 

3 个 虚拟 传感器 的 最 基本 应 用 是 检测 地 面 接触 。 因 此 ， 为 了 比较 它们 完成 这 
个 任务 的 能 力 ， 用 本 节 上 述 方法 进行 了 评估 。 表 8. 1 总 结 了 当 使 用 12 种 不 同 Fr 
评估 虚拟 传感器 时 获得 的 结果 。 结 果 的 特征 在 于 : 在 测试 集 A 和 测试 集 C 情况 
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下 测量 的 关于 Fr 的 接触 力 的 标准 误差 以 及 在 测试 集 B 情况 下 的 平均 接触 力 的 
特征 。 l 


R 8.1 在 地 面 检测 实验 中 测量 的 接触 力 的 标准 误差 % 


单 轴 力 传感器 
4.1 | 5.3 


测试 集 A 
测试 集 B 
测试 集 C 


2:9) | Baf 


5.7 


这 种 方法 在 不 规则 地 形 上 运动 的 可 行 性 已 经 通过 实验 测试 。 在 第 1 个 实验 
中 ，SILO4 机 器 人 走 过 图 8. 14 所 示 的 未 知 不 规则 地 形 ， 只 有 单 轴 力 传感器 。 图 
8.15 (a) 绘制 了 单 轴 力 传 感 器 的 估计 值 和 校准 传感器 在 前 足 中 所 记录 的 力 。 佑 
计 仅 需 在 摆动 的 最 后 部 分 才 检 测 地 面 接触 。 当 估计 的 足 力 达到 50N 时 ， 腿 部 向 
下 运动 完成 。 在 第 2 个 实验 中 ， 为 了 便于 比较 ， 将 校准 传感器 用 于 地 面 检测 [图 
8:15 <b) I]. 


图 8.14 SILO4 实验 平台 


8.5.5 讨论 


8.4 节 提出 的 结果 表明 ， 虚 拟 传感器 设计 不 仅 是 可 行 的 ， 而 且 是 检测 足 / 地 
面 接触 功能 的 有 效 方法 。 实 验 测试 证 实 ， 具 有 1 个 隐 层 和 5 个 隐藏 神经 元 的 前 馈 
网 络 足 以 对 该 系统 进行 建 模 ， 并 在 此 应 用 中 给 出 满意 的 结果 。 使 用 这 种 神经 网 络 
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足 力 /N 
足 力 /N 


0 50 100 150 200 


(a) 虚拟 传感器 估计 (b) 校准 传感器 测量 
一 一 一 校准 传感器 测量 Oooo 虚拟 传感器 估计 


图 8.15 在 不 规则 地 形 运动 期 间 测量 的 力 


所 增加 的 计算 负担 非常 低 ， 因 为 计算 估计 所 需 的 完整 时 间 小 于 控制 环 周期 的 
5%。 仅 以 计算 负担 上 轻微 增加 就 可 消除 传感器 、 布 线 和 电子 设备 ， 特 别 是 在 需 
要 追求 简单 性 的 系统 中 极 具 价值 ， 如 腿 式 机 器 人 ; 在 价格 上 也 可 以 保持 优势 。 输 
入 一 组 幅度 就 可 以 对 诸如 黏 性 、 位 置 相关 摩 控 、 重 力 等 各 种 效应 进行 建 模 。 但 
是 ,在 非常 低 的 关节 速度 下 对 静摩擦 和 秋 滑 行为 的 正确 建 模 尚未 确认 。 这 是 因为 
在 用 于 地 面 检测 的 足 的 速度 和 轨迹 范围 内 ， 至 少 在 这 种 腿 部 运动 学 配置 中 接近 堆 
关节 速度 条 件 不 会 出 现 。 在 力 估计 的 最 一 般 情况 下 ， 在 给 定 的 足 轨迹 产生 期 间 ， 
关节 速度 可 能 下 降 到 零 ， 那 么 ， 校 准 样本 应 该 考虑 这 种 情况 ， 结 果 应 该 仔细 验 
证 ， 也 人 允许 比较 几 种 响应 行为 。 

在 运行 条 件 下 虚拟 开关 对 碰撞 瞬间 的 估计 精度 在 训练 集中 是 非常 令 人 满意 
的 。 实 验 表 明 ， 接触 力 与 足 轨迹 和 速度 之 间 没 有 明确 的 依赖 关系 ， 并 且 由 于 操作 
点 之 间 的 差异 而 导致 结果 分 散 也 是 可 以 接受 的 (图 8.4)。 虚 拟 开关 的 重复 精度 
也 非常 令 人 满意 (图 8.6)。 然 而 ， 由 于 操作 条 件 与 训练 集中 包含 的 操作 点 的 差 
异 较 大 ， 因 此 估计 的 准确 度 会 变 差 ， 这 表明 这 种 虚拟 传感器 的 泛 化 特性 差 (图 
8.5)。 网 络 预测 的 幅度 之 间 相 关 性 的 能 力 受到 用 于 训练 网 络 的 开关 信号 中 包含 的 
有 限 信息 的 阻碍 。 实 验 还 表明 ， 该 虚拟 开关 可 以 在 适当 的 力 的 范围 内 针对 不 同 的 
力 阔 值 进行 校准 。 研 究 发 现 力 阔 值 与 估计 精度 之 间 没 有 明确 的 依赖 关系 。 实 验 设 
置 的 简单 性 是 这 种 虚拟 传感器 的 主要 优点 ， 因 为 只 需要 一 个 物理 开关 作为 校准 传 
感 器 。 

在 模拟 训练 集中 考虑 的 操作 条 件 的 实验 中 ， 单 轴 力 传感器 显示 出 非常 好 的 精 
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度 (图 8.8)。 此 外 ， 该 力 估计 系统 显示 出 优秀 的 泛 化 特征 ， 在 整个 正常 工作 范 
围 内 获得 与 任何 轨迹 和 足 端 速 度 相似 的 精度 。 这 个 虚拟 力 传感器 在 各 个 方面 ， 尤 
其 是 泛 化 方面 优 于 虚拟 开关 (图 8.9)。 显 然 ， 估 计 的 精度 取决 于 足 的 速度 GK 
度 越 高 ， 相 关 性 越 低 )， 没 有 发 现 对 足 端 轨迹 的 依赖 性 (图 8. 11)。 这 种 虚拟 传 
感 器 性 能 的 增强 是 建立 在 幅 值 关系 的 模拟 信息 较为 丰富 的 结果 之 上 。 与 虚拟 开关 
相 比 ， 该 虚拟 传感器 的 唯一 缺点 是 所 需 的 实验 附加 硬件 的 复杂 性 更 高 。 

在 三 轴 力 传感器 的 实验 表明 ， 估 计 精 度 高 (5%)， 在 整个 工作 范围 内 一 致 性 
好 (图 8.13)。 每 个 力 分 量 的 估计 精度 也 与 使 用 单 轴 力 传感器 获得 的 精度 非常 相 
似 。 因 此 ， 在 保持 估计 精度 的 情况 下 ， 这 种 虚拟 传感器 的 使 用 比 虚 单 轴 力 传感器 
性 能 更 强 。 更 长 的 训练 时 间 和 更 复杂 的 实验 硬件 是 唯一 的 缺点 。 

考虑 到 这 些 结果 ， 发 现 选择 用 于 组 成 训练 样本 集 的 操作 点 的 数量 足以 描述 虚 
拟 力 传感器 的 完整 操作 范围 。 具 体 地 ， 虚 拟 传感器 能 够 计算 包含 在 腿 部 工作 空间 
中 的 任何 直线 足 端 轨迹 的 精确 估计 ， 以 及 适用 于 在 运动 期 间 使 用 的 任何 足 的 速度 
(0.025~0.1m/s). {FH Levenberg - Marquardt 学 习 算法 ， 可 以 在 短 时 间 内 用 
上 述 训 练 集 来 训练 网 络 ， 满 足 存储 器 的 要 求 。 这 个 事实 使 得 包含 更 多 数量 的 描述 
及 更 多 种 类 轨迹 的 示例 成 为 可 能 。 在 所 有 情况 下 ， 完 整 的 校准 过 程 是 最 快速 和 直 
接 的 。 

Be 8. 1 中 虚拟 传感器 的 最 终 比 较 表 明 ， 虚 拟 单 轴 力 传感器 是 检测 地 面 接触 的 
最 有 效 选择 。 实 验 表 明 ， 步 行 机 器 可 以 使 用 该 虚拟 传感器 穿越 未 知 的 不 规则 地 
形 。 在 实验 中 ， 在 每 个 腿 摆动 结束 时 记录 的 力 超过 指定 的 Fr (50N) 高达 10N。 
然而 ， 当 物理 传感器 用 于 检测 地 面 时 也 会 观察 到 这 种 影响 (图 8. 15) 。 这 主要 是 
由 用 于 检查 力 和 控制 足 端 向 下 运动 的 控制 回路 周期 引起 的 。 在 第 二 种 情况 下 观察 
到 的 误差 稍 小 ， 因 为 该 传感器 用 于 校准 虚拟 传感器 。 无 论 如 何 ， 这 些 误差 并 不 影 
响 步 行 机 器 的 适应 性 ， 最 后 的 结论 是 运动 不 受 使 用 物理 或 虚拟 传感器 的 影响 。 虚 
拟 传 感 器 增强 了 机 器 的 鲁 棒 性 和 可 用 的 传 感 信息 的 质量 ， 所 以 配置 有 虚拟 传感器 
的 机 器 实际 上 可 以 更 好 地 运行 。 


8.6 结论 


本 章 描述 了 用 于 步行 机 器 人 的 地 面 检测 系统 的 开发 和 测试 。 已 经 选择 了 关节 
位 置 误差 、 关 节 速 度 和 关节 位 置信 号 作为 虚拟 传感器 的 一 组 可 行 的 输入 来 估计 机 
器 人 足 部 施加 的 力 。 这 些 输入 可 以 从 大 多 数 机 器 人 系统 中 可 用 的 关节 位 置 传感器 
中 获取 ， 因 此 该 虚拟 传感器 的 实现 不 会 导致 额外 的 硬件 负担 。 

已 经 证 明 数 据 驱 动 的 虚拟 传感器 是 若干 个 机 器 人 平台 传 感 系统 的 合适 选择 。 
使 用 前 馈 神经 网 络 处 理 输入 信息 并 产生 的 输出 已 被 实验 证 明 是 真正 的 步行 机 器 人 
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中 的 一 个 可 行 的 解决 方案 。 建 立 了 校准 程序 ， 目 的 是 便于 对 这 些 虚拟 传感器 进行 
调节 。 校 准 程序 允许 检测 系统 在 短 时 间 内 ， 以 最 小 的 实验 设置 进行 校准 ， 所 需 的 
实验 与 正常 的 运动 过 程 非常 相似 。 已 经 发 现在 第 一 种 方法 中 获得 的 结果 是 令 人 满 
意 的， 目前 正在 用 于 SILO4 步行 机 器 人 进行 地 面 探测 。 使 用 该 虚拟 传感器 获得 
的 力 估计 的 良好 质量 ， 使 其 成 为 物理 传感器 的 可 行 替 代 方 案 。 由 于 该 方法 易于 适 
应 其 他 机 器 ， 因 此 对 简化 伺服 控制 系统 的 硬件 或 为 其 提供 低 成 本 的 传感器 元 余 是 
一 个 很 好 的 选择 。 
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防 第 9 章 人 机 界面 


9.1 简介 


机 器 人 被 设计 为 在 复杂 、 易 疲劳 和 危险 任务 中 取代 人 类 操作 员 ， 并 且 初 步 估 
计 认 为 机 器 人 可 以 在 孤立 的 环境 中 完全 自主 地 运行 。 然而， 当前 工业 和 服务 业 需 
求 在 同一 工作 环境 中 与 人 类 一 起 工作 的 机 器 人 。 这 就 涉及 人 类 与 机 器 人 通过 人 机 
界面 HMD 的 交互 系统 进行 相互 通信 的 问题 。 

第 一 代 HMI 是 基于 监控 控制 的 概念 ， 其 中 操作 者 将 整个 任务 划分 成 可 以 由 
机 器 人 成 功 实现 的 多 个 子 任务 。 操 作 员 总 是 操控 机 器 人 ， 并 且 需 要 对 机 器 人 的 能 
力 有 全 面 了 解 ， 以 便 进 行 有 效 和 高 效 的 控制 。 这 种 方案 〈 远 程 操纵 机 器 人 而 不 是 
远程 操作 车 辆 ) 对 于 与 机 器 人 无 关 的 领域 的 专家 用 机 器 人 高 级 设计 工具 是 不 利 的 
(Blackmon 和 Stark，1996) 。 改 进 人 机 交互 的 最 新 尝试 是 通过 考虑 机 械 模型 (四 
AX. PLAS) (Prokopiou 等 ，1999) 和 人 类 行为 模型 (Rosenblatt, 1997), 将 
人 的 模型 插入 到 控制 回路 中 。 这 称 为 人 一 机 控制 架构 ， 它 将 操作 者 视 为 男 一 个 模 
块 ， 将 决策 或 人 类 感知 作为 在 众多 潜在 行动 中 可 进行 选择 的 附加 模块 (Fong $, 
1999), 

多 模式 操作 员 界 面 和 监控 控制 广泛 应 用 于 移动 机 器 人 的 远程 操作 和 人 机 界 
面 ， 也 似乎 足以 用 于 步行 机 器 远程 操作 。 多 模式 接口 为 操作 员 提 供 了 各 种 控制 模 
式 和 显示 。 这 些 控制 模式 包括 单独 的 致 动 器 控制 〈 关 节 控 制 )， 协 调控 制 〈 腿 部 
控制 )， 任 务 控 制 -( 机 体 运动 、 轨 迹 执 行 ) 等， 而 显示 器 提供 数字 信息 (关节 和 
足 部 位 置 ， 稳 定 裕 度 ) 、 几 何 信息 〈 机 器 人 姿态 ) 、 触 觉 信 息 〈 触 觉 和 力 反馈 信息 
技术 ) 等 。 

协同 控制 是 HMI 的 进一步 发 展 。Fong (1995) 等 引入 的 这 个 新 理念 ， 认 为 
人 和 机 器 人 控制 器 都 处 于 相同 的 分 层 决 策 层面 ， 相 互 合作 执行 任务 和 完成 目标 。 
机 器 人 遵循 操作 人 员 指 定 的 高 级 任务 ， 但 它 询 问 人 们 如 何 实现 任务 ， 如 何 使 用 不 
清楚 的 传 感 信息 等 。 机 器 人 控制 器 同时 决定 如 何 使 用 、 修 改 或 拒绝 人 类 的 指示 。 
因此 ， 机 器 人 以 专家 的 角色 帮助 操作 者 来 共同 努力 实现 任务 (Fong 等 ，1995) 。 

步行 机 器 是 一 种 特殊 类 型 的 移动 机 器 人 。 它 们 的 特征 在 于 具有 优 于 轮 式 机 需 
人 一 些 优 点 ， 也 有 复杂 性 和 固有 的 低速 属性 等 缺点 〈1. 3 节 和 1.4 节 )。 步 行 机 
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器 人 的 全 方位 性 及 其 跨越 非常 崎 虹 的 地 形 的 能 力 是 这 种 机 器 最 重要 的 特征 。 因 
此 ， 这 些 特性 必须 加 以 利用 以 获得 比 传统 的 轮 式 或 履带 式 车 辆 明显 的 优点 。 然 
而 ， 步 行 机 器 的 复杂 性 使 得 它们 难以 被 外 行人 操作 ， 从 而 在 运输 、 建 筑 等 领域 的 
应 用 受 限 。 

步行 机 器 人 技术 虽然 有 很 大 的 发 展 ， 特 别 是 在 步 态 生 成 、 腿 部 设计 、 力 量 控 
制 等 方面 ， 但 其 HMI 研究 却 不 足 。 参 考 文 献 (Bares 和 Wettergreen, 1999; 
Fong , 1999; Takanobu 等 ，1999) 提供 了 相关 研发 实例 。 操 作 步 行 机 器 人 应 
该 像 给 定 速度 指示 蟹 行 角度 轨迹 一 样 简单 。 然 而 ， 稳 定 的 行走 意味 着 产生 足够 的 
立足 点 和 腿 部 运动 顺序 ， 使 机 器 适应 不 规则 地 形 ， 避 免 踩踏 禁止 区 域 等 。 所 有 这 
些 任务 对 于 步行 机 器 人 来 说 都 是 非常 困难 的 ， 必 须 由 机 器 人 控制 器 负责 ， 通 过 运 
行 特定 的 连续 、 不 连续 (第 3 章 ) 或 自由 步 态 算法 来 实现 〈 第 4 章 )。 机 器 执行 
自由 的 步 态 算法 时 ， 特 别 适用 于 在 包含 禁区 的 不 平坦 地 形 上 行走 ， 但 可 能 会 发 生 
腿 部 锁 死 (第 4 章 )， 因 此 人 的 干预 变 得 至 关 重 要 。 克 服 这 种 问题 通常 需要 操作 
员 在 底层 (关节 级 别 ) 命令 系统 。 因 此 ， 多 模式 界面 似乎 是 步行 机 器 人 HMI 的 
最 佳 选择 。 另 外 ， 环 境 信 息 对 于 进行 地 形 适 应 、 运 动 优 化 和 保证 任务 安全 均 至 关 
重要 。 但 由 于 传 感 系统 的 缺陷 ， 这 些 信 息 可 能 不 可 用 或 不 完整 。 因 此 ， 控 制 器 应 
该 能 够 与 操作 员 交 换 信息 ， 以 完成 其 内 部 环境 的 表示 或 者 要 求 适当 的 命令 。 操 控 
这 样 一 台 复 杂 的 机 器 ， 对 于 操作 员 而 言 是 一 项 艰巨 的 任务 。 因 此 ， 控 制 器 应 该 能 
够 拒绝 错误 或 执行 与 操作 员 相 反 的 命令 ， 并 提出 可 能 的 解决 方案 ， 与 操作 者 协商 
以 获得 足够 的 指导 。 这 是 一 种 协同 控制 ， 对 于 步行 机 器 HMI 设计 来 说 非常 有 吸 
Elbe 

本 章 重 点 介绍 步行 机 器 人 的 HMI 设计 。HMI 基于 多 模 态 界面 ， 其 中 包含 协 
作 控 制 功 能 。 应 特别 注意 人 机 界面 的 可 操作 性 和 HMI 的 人 性 化 。 通 过 使 用 友好 
的 图 形 界面 来 改善 操作 ， 帮 助人 类 操作 员 在 不 平坦 地 形 操纵 机 器 人 。9. 2 节 介 绍 
了 基于 系统 和 步 态 特征 的 HMI， 以 及 多 模式 和 协同 控制 的 概念 。9. 2. 1 一 9. 2. 10 
节 描 述 组 成 HMI 的 不 同 模块 。9. 2. 11 节 描 述 了 HMI 中 包含 的 协同 控制 器 的 操 
作 。 最 后 ， 在 9. 3 节 说 明 一 些 结论 。 


9.2 人 机 界面 和 协同 控制 器 


本 章 开 发 的 图 形 化 HMI 有 两 个 主要 特点 。 首 先 ， 开 发 模拟 和 优化 了 四 足 机 
器 人 的 自由 步 态 算法 [第 4 章 和 (Estremera 等 ，2002)]。 其 次 ， 作 为 一 个 操作 
界面 ， 它 在 执行 一 个 自由 的 步 态 算法 时 ， 能够 实时 地 命令 和 监视 四 足 的 运动 。 这 
两 个 功能 集成 在 一 起 ， 图 形 化 用 户 界 面 (GUD 可 以 接收 数据 并 为 模拟 器 和 真实 
机 器 人 生成 指令 。 
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提出 了 一 种 协同 控制 器 来 改善 HMI， 以 实现 以 下 两 个 主要 目标 : 

(1) 使 步行 机 器 人 的 操纵 尽 可 能 简单 ， 使 操作 员 能 够 沿 着 由 直线 段 、 圆 弧 以 
及 纯 旋转 组 成 的 复杂 路 径 引导 机 器 人 。 这 包括 以 下 子 目标 : 

1) 提供 一 种 组 合 不 同步 态 〈 盘 行 步 态 、 转 弯 步 态 和 旋转 步 态 ) (第 3 章 和 第 
4 章 ) 并 修改 其 参数 ( 蟹 行 角度 、 转 弯 半 径 等 ) 的 方法 。 

2) 使 操作 员 可 以 不 考虑 步行 机 器 的 特殊 特征 和 步 态 生 成 方法 ， 从 而 允许 机 
器 人 的 控制 器 可 以 忽略 操作 者 的 不 恰当 命令 或 暗示 适当 的 命令 。 

(2) 提高 步行 机 器 的 地 形 适应 性 ， 但 不 会 过 度 增加 操作 员 的 工作 量 。 为 了 优 
化 不 规则 地 形 的 运动 ， 在 步行 机 器 中 可 以 调整 的 参数 数量 非常 多 。 为 了 便于 调 
整 ， 协 同 控制 器 应 该 完成 以 下 子 目 标 : 

D 帮助 完成 优化 有 关机 器 人 运动 所 需 的 环境 信息 。 为 此 ， 协 同 控制 器 可 以 
要 求 地 形 的 一 般 特 征 的 信息 ， 这 些 信息 不 能 从 传感器 提供 的 有 限 和 本 地 的 信息 中 
推导 出 来 。 当 传 感 信息 不 清楚 或 不 可 用 时 ， 协 同 控制 器 还 可 以 向 操作 者 询问 地 形 
的 某 些 局 部 特征 。 最 后 ， 当 检测 到 潜在 的 危险 情况 时 ， 它 可 以 从 操作 员 那 里 征求 
命令 。 

2) 协同 控制 器 帮助 操作 者 了 解 地 形 的 一 些 局 部 特征 或 通过 地 形 的 历史 记录 
辅助 操作 员 做 出 决定 。 此 外 ， 协 同 控制 器 可 以 建议 操作 员 执 行 可 能 的 命令 ， 以 减 
轻 操 作 员 的 工作 量 。 

协同 控制 器 允许 操作 员 忽 略 步 态 生成 特征 的 例子 如 下 。 步 态 生成 模块 是 机 器 
人 实现 的 高 级 别 的 自主 控制 ， 操 作 员 负责 路 径 规划 。 实 现 自由 步 态 自主 执行 时 ， 
操作 员 仅 确定 某 些 步 态 参数 来 定义 路 径 及 某 些 要 求 ， 如 蟹 行 角 、 旋 转 中 心 、 绝 对 
稳定 裕 度 等 。 然 而 ， 操 作 员 的 某 些 决 定 可 能 会 阻碍 步 态 规划 并 导致 锁 死 。 例 如 ， 
在 某 些 情况 下 ， 由 用 户 制定 的 蟹 行 角 或 最 小 稳定 裕 度 可 能 难以 找到 足够 的 立足 
点 。 因 此 ， 步 态 规划 可 以 推断 锁 死 情况 的 可 能 性 。 在 这 种 情况 下 ， 协 同 控制 器 可 
以 询问 人 类 操作 员 放 弃 这 些 参数 ， 或 者 人 在 合理 期 限 内 没有 回应 时 控制 器 可 以 决 
定 自 己 改 变 它 们 : 

接 下 来 描述 控制 器 必须 与 操作 员 合作 ， 以 提高 性 能 的 例子 。 机 器 人 可 以 通过 
使 用 离散 的 足 接触 点 来 估计 地 形 。 如 果 所 有 的 接触 点 处 于 相同 的 高 度 ， 机 器 人 则 
认为 在 平坦 的 地 形 上 行走 。 在 这 种 情况 下 ,机 器 人 应 该 使 用 非常 小 的 迈步 高 度 ， 
从 而 增加 其 整体 速度 。 然 而 ， 即 使 在 不 平坦 的 地 形 上 行走 ， 也 会 导致 相同 的 足 端 
高 度 ， 这 是 因为 仅 有 几 个 离散 点 的 信息 。 这 里 的 协作 解决 方案 是 控制 器 可 以 向 人 
类 操作 员 询 问 地 形 的 属性 。 通 过 分 析 简 单 的 屏幕 图 像 ， 人 类 操作 者 可 以 轻松 推断 
地 形 的 属性 。 或 者 协同 控制 器 可 以 提出 可 能 的 命令 〈 步 高 修正 ) ， 并 等 待 操作 员 
的 批准 。 类 似 的 情况 是 机 器 在 斜坡 上 行走 控制 器 可 以 根据 足 端 位 置 推断 出 它 正 
在 上 /下 斜坡。 在 这 些 情况 下 ,重要 的 是 调整 机 器 人 到 地 形 的 高 度 ， 以 优化 步 态 ， 
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但 是 机 器 人 可 能 难以 确认 地 形 的 这 些 属性 。 而 且 操 作 员 可 以 帮助 控制 器 实现 任 
务 。 这 些 决定 可 以 由 机 器 人 自主 进行 ， 但 是 ， 由 于 安装 的 传感器 类 型 只 是 基于 其 
环境 的 某 些 局 部 特征 ， 或 者 是 它 所 经 历 的 单一 环境 历史 有 限 ， 将 导致 机 器 人 的 自 
主 决定 可 能 不 准确 或 延迟 。 此 外 ， 不 正确 的 传 感 信息 有 时 会 危及 任务 的 安全 。 为 
了 保证 更 安全 的 运行 ， 控 制 器 可 以 从 传 感 数据 推导 出 风险 的 情况 ， 要 求 操作 员 的 
协作 (要求 提供 信息 或 征求 推荐 动作 的 批准 )。 

总 而 言 之 ， 如 果 操 作 员 不 能 合作 ， 机 器 人 将 自动 运行 ， 从 而 带 来 限制 和 风 
险 。 一 方面 ， 操 作 员 合作 (如 果 有 的 话 ) 可 以 帮助 以 更 安全 和 更 有 效 的 方式 完成 
任务 。 另 一 方面 ， 完 全 远程 操作 的 解决 方案 将 占用 用 户 太 多 精力 ， 因 为 机 器 的 信 
息 反馈 较 差 。 

在 HMI 的 定义 中 ， 主 要 关注 顶层 命令 和 数据 ， 以 减轻 操作 员 的 工作 量 。 因 
此 ， 这 是 一 种 面向 步 态 协 作 的 界面 。 然 而 ， 操 作 员 可 能 会 面 对 不 同 的 控制 层次 ， 
以 便 在 步行 机 器 发 展 的 不 同 阶 段 ， 执 行 不 同情 况 下 所 需 的 各 种 动作 。 因 此 ， 
HMI 是 基于 多 模式 结构 ， 其 中 操作 员 可 以 在 从 单 轴 运 动 到 自主 行走 的 不 同 控制 
层次 下 起 作用 。 

在 Bares 和 Wettergreen (1999) 完成 的 工作 之 后 ，GUI 被 组 装 在 多 个 模块 
中 ， 使 得 根据 区 域 和 环境 的 特定 类 型 功能 的 命令 或 信息 被 分 组 在 一 起 。 通 过 图 形 
显示 、 数 字 显 示 和 信息 文本 ， 向 操作 员 提 供 有 关 车 辆 状态 的 信息 。 为 控制 一 模拟 
环境 、 步 态 环境 、 行 走 环境 和 致 动 器 环境 的 区 域 定 义 车 辆 控制 的 不 同 级 别 。 命 令 
行 界面 和 协同 控制 环境 是 获取 信息 和 生成 控制 命令 的 蔡 代 方法 。 除 了 这 些 模块 之 
外 ，GUI 中 还 包括 地 形 建 模 环境 和 图 形 控制 环境 (图 9. 1)。 


9.2.1 图 形 显示 


该 显示 器 用 于 以 直观 、 友 好 的 方式 提供 有 关机 器 人 状态 和 步 态 生成 的 高 级 信 
息 。 图 形 表示 主要 用 于 方便 操作 员 了 解 步 态 生成 〈 腿 部 序列 和 立足 点 搜索 ) 的 进 
度 ， 以 及 快速 获取 有 关 足 的 位 置 、 稳 定 裕 度 、 禁 止 区 域 等 信息 。 根 据 这 些 信息 ， 
经 验 丰富 的 操作 员 可 以 改变 一 些 步 态 参数 EAE, ERRET) 以 优化 速度 
或 运动 的 安全 性 。 图 形 表示 取决 于 自由 步 态 的 产生 方式 。 如 4. 4. 2. 1 节 所 述 ， 在 
步 态 规划 中 仅 考 虑 机 器 人 的 水 平 投影 ， 因 此， 二 维 图 形 表示 是 以 提供 足够 的 信 
息 。 使 用 不 连续 步 态 以 及 考虑 到 禁止 区 域 ， 使 得 可 以 使 用 机 器 人 和 地 形 的 二 维 表 
示 。 另 外 ， 二 维 表示 是 用 于 步行 机 器 人 控制 器 的 计算 成 本 低 的 解决 方案 。 然 而 ， 
在 开发 阶段 ， 直 接 视觉 〈 或 视觉 系统 ) 反馈 是 强制 性 的 ， 用 以 有 效 地 控制 机 器 。 
该 图 形 界 面 中 包含 显示 在 主 窗口 右上 角 的 两 个 不 同 的 图 形 表 示 。 

1. 静态 表示 

静态 表示 显示 了 步行 机 器 人 的 简单 图 像 和 一 些 可 用 于 测试 和 监视 自由 步 态 算 
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步 态 环境 MARM 
地 形 建 模 


图 9.1 部 分 图 形 用 户 界面 


法 的 图 形 信息 。 由 步行 机 器 人 的 顶 视图 组 成 ， 其 中 观察 者 位 于 机 体 的 参考 系 坐 标 
系 之 上 。 以 下 元 素 形成 此 屏幕 (图 9. 2) : 

(1) 步行 机 器 人 。 机 器 人 水 平 投影 的 简单 二 维 方案 显示 了 机 体 和 腿 的 位 置 和 
状态 〈 摆 动 或 支撑 ) 。 支 撑 相 的 腿 在 足 端 附近 有 一 个 圆圈 。 机 器 人 机 体 的 位 置 和 
方向 在 屏幕 上 保持 《静态 )， 以 方便 观察 。 还 表示 了 腿 部 工作 空间 的 水 平 投影 、 
支撑 多 边 形 和 重心 的 水 平 投影 (由 具有 半径 等 于 最 小 期 望 稳定 裕 度 的 圆周 包围 的 
SSM )。 

(2) 足迹 规划 。 当 一 个 足 的 转移 确定 最 佳 立足 点 (第 4 章 ) 时 ， 可 以 在 屏幕 
上 看 到 以 下 元 素 〈 点 和 线 ) (图 9. 2) : 

1) 几 条 直线 表示 对 未 来 立足 点 位 置 的 几何 限制 〈 这 些 线 定义 了 第 4 章 描述 
的 立足 点 ) 。 

2) 一 些 点 可 以 代表 满足 这 些 限制 的 可 能 立足 点 。 

3) 一 个 表示 最 佳 立足 点 位 置 的 点 。 

G) 顺序 规划 。 下 一 个 被 提升 的 腿 被 标记 为 不 同 的 颜色 。 

(4) 方向 指示 灯 。 该 指示 灯 显 示 外 部 参考 系 的 轴 方 向 。 由 于 在 该 表示 中 机 器 
人 的 机 体 保 持 静 止 ， 所 以 航向 指示 器 用 作 罗 盘 ， 帮 助 操 作 员 了 解 机 器 人 的 方位 。 
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图 9.2 静态 表示 


G) 蟹 行 角 指 示 器 。 指 示人 蟹 行 角 的 矢量 ,显示 机 器 人 相对 于 外 部 参考 系 移动 
的 方向 。 

(6) 条 形 图 。 几 幅 图 形 指示 器 显示 步 态 计划 采用 的 相关 幅度 : 每 条 腿 的 运动 
WA (KM), 、 绝 对 稳定 裕 度 (SSM) 以 及 其 他 稳定 性 测量 值 。 

2. 动态 表示 

动态 表示 是 机 器 人 在 其 环境 中 的 直观 描述 。 该 表示 的 主要 特征 描述 如 下 (图 
9.3): 

观察 者 位 于 外 部 参考 系 中 ， 因 此 机 器 人 在 地 形 上 的 轨迹 和 由 其 在 屏幕 上 的 图 
形 表示 描述 的 轨迹 之 间 存 在 对 应 关系 。 

可 以 创建 具有 障碍 物 〈 非 实际 地 形 ) 的 模拟 环境 ， 以 便 确定 达到 目标 的 最 佳 
轨迹 ， 以 及 评估 操作 员 是 否 能 够 遵循 特定 轨迹 ， 灵活 机 动 ， 避 人 免 碰 撞 。 

禁止 区 域 可 能 包含 在 模拟 地 形 中 ， 以 确定 机 器 人 是 否 能 找到 跟随 特定 轨迹 的 
必要 立足 点 。 地 形 被 划分 为 方形 单元 格 ， 每 个 单元 格 的 颜色 表示 其 中 包含 的 地 形 
类 型 (4.2.2 FF). 

Ee FT SATB ARETE 9. 2. 1 节 描 述 ， 有 助 于 操作 车 辆 。 


9.2.2 图 形 控制 环境 


该 区 域 将 与 机 器 人 的 图 形 表示 相关 的 一 些 命令 组 合 在 一 起 (图 9. 1) 。 它 包括 
放大 和 缩小 控件 ， 以 更 改观 察 者 的 位 置 ， 并 更 改 绘图 刷新 率 ， 以 便 详细 观察 或 加 
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图 9. 3 动态 表示 
快 模拟 。 操 作 员 也 可 以 在 静态 表示 和 动态 表示 之 间 切 换 。 


9.2.3 数字 显示 


显示 器 以 非 直观 的 方式 提供 精确 的 数值 信息 。 它 有 利于 步 态 生成 的 详细 分 析 
和 指示 底层 命令 。 主 窗口 右 侧 打印 出 以 下 数字 信息 : 

(1) 参考 世界 参考 系 机 体 坐 标 和 方向 ， 由 目 视 测量 法 估计 。 

(2) 参考 机 器 人 参考 系 的 腿 坐标 。 

(3) 运动 开始 后 的 模拟 时 间 。 

(4) 步 态 、 蟹 行 角 、 旋 转 中 心 和 转弯 半径 的 类 型 。 

(5) 每 条 腿 的 运动 边界 和 最 小 的 运动 边界 。 

(6) 绝对 稳定 裕 度 SSM, 


9.2.4 传 感 环境 


在 这 种 环境 下 分 组 的 显示 器 用 于 监测 传 感 信息 。 来 自 双 轴 倾 斜 仪 、 力 传感器 
和 足 部 电位 器 的 数据 显示 为 数字 指示 器 。 在 系统 故障 和 调试 阶段 ， 关 于 机 器 人 状 
态 的 底层 信息 在 一 个 单独 的 窗口 中 显示 ， 以 避免 在 正常 情况 下 向 操作 员 显 示 超 出 
的 数据 (图 9. 4) 。 在 协作 系统 中 ， 此 环境 可 向 用 户 预 警 传感器 数据 是 否 已 进入 
危险 范围 。 控 制 器 可 以 考虑 操作 员 的 建议 或 自己 采取 行动 。 
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9.2.5 地 形 建 模 环 境 


为 了 监控 带 有 禁区 的 地 形 上 自由 步 态 的 行进 ， 控 制 器 中 包含 了 一 个 简单 的 
地 形 建 模 机 制 (4. 2. 2 节 )。 放 置 在 地 形 建 模 环境 中 的 命令 允许 操作 员 创 建 禁 
止 单元 的 分 布 (图 9. 1)。 这 种 分 布 可 以 随机 完成 ， 可 以 选择 禁止 单元 的 比例 
或 者 通过 使 用 光标 手动 模拟 一 个 特定 的 地 形 。 后 者 可 以 模拟 计算 机 器 人 是 否 能 
够 通过 具有 禁止 区 域 的 特定 地 形 ， 有 助 于 在 移动 真实 机 器 之 前 找到 最 佳 移动 
方式 。 


9.2.6 控制 仿真 环境 


通过 添加 一 些 命令 来 实现 模拟 器 和 控制 器 的 共存 。 这 些 功能 之 间 可 以 切换 ， 
并 选择 仿真 器 作为 真实 机 器 人 的 主机 或 从 机 (图 9.1)。 这 些 命 令 有 助 于 实现 一 
些 实验 和 先期 的 仿真 (Estremera 等 ，2002) 。 


9.2.7 步 态 环境 


步 态 环境 中 包含 命令 (图 9. 1) ， 人 允许 操作 员 实 时 操纵 机 器 人 。 操 作 员 只 需 
考虑 机 器 的 轨迹 和 速度 ， 给 出 简单 直观 的 命令 ， 就 好 像 机 器 人 是 轮 式 车 辆 一 样 。 
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目前 ， 这 种 环境 是 车 辆 的 最 高 控制 层次 。 侯 行 步 态 、 转 弯 步 态 和 旋转 步 态 可 以 轻 
松 地 组 合 起 来 ， 以 跟随 轨迹 或 到 达 环 境 中 的 指定 点 ， 同 时 避免 障碍 物 。 操 作 员 可 
以 实时 使 用 以 下 控件 来 驱动 机 器 : 

(1) 侯 行 角 。 通 过 点 击 屏 幕 上 的 两 个 按钮 可 以 将 蟹 行 角 增加 或 减少 固定 的 角 
度 。 这 有 利于 在 机 器 人 的 轨迹 上 进行 小 的 校正 或 者 沿 着 平滑 的 轨迹 转向 而 不 失去 
其 姿态 角 。 其 他 4 个 按钮 允许 操作 员 选 择 4 个 预定 的 稻 行 角 ， 以 便 机 器 人 沿 着 其 

负 两 个 方向 的 x 轴 和 y 轴 移 动 。 

(2) 转弯 和 旋转 方向 。 可 以 通过 两 个 按钮 直接 选择 顺 时 针 或 逆 时 针 自 由 转弯 
步 态 。 当 执行 转弯 步 态 时 ， 这 些 按钮 用 于 选择 转动 方向 。 

(3) 旋转 中 心 。 操 作 员 可 以 使 用 光标 选择 转向 自由 步 态 的 旋转 中 心 ， 这 是 一 
种 直观 的 方式 来 克服 障碍 。 然 而 ， 当 机 器 人 必须 遵循 由 不 同 弧 轨迹 组 成 的 复杂 路 
径 时 ， 该 过 程 是 无 益 的 。 因 此 ， 已 经 评估 了 另 一 种 方法 ， 其 旋转 中 心 的 位 置 可 以 
沿 着 机 器 的 横 轴 移动 ， 相 当 于 改变 转弯 半径 ， 这 样 就 可 以 将 机 器 人 像 传 统 的 轮 式 
车 辆 一 样 转向 。 

(4) 步 态 速度 。 此 控制 定义 机 器 的 平均 速度 机 器 的 平均 速度 主要 取决 于 地 
形 、 鼻 行 角 等 ， 因 此 ， 步 态 速度 只 是 操作 员 提 出 的 一 种 速度 推荐 。 

模拟 和 实验 表明 ， 只 需 执行 这 些 控制 命令 就 可 以 驱动 机 器 人 到 达 给 定 的 目 
标 ， 或 者 使 用 两 个 旋转 和 蟹 行 角 的 变化 来 遵循 预定 义 的 路 径 。 


9.2.8 步行 环境 


步行 环境 用 于 定义 机 器 人 运动 的 一 般 规范 ， 生 成 命令 以 优化 特定 地 形 或 情况 
下 的 步 态 。 步 行 环境 表示 运动 控制 的 底层 环境 ， 因 此 已 经 在 单独 的 窗口 中 实现 ， 
以 最 小 化 呈现 给 操作 员 控 制 。 本 文中 的 命令 用 于 改变 与 地 形 适 应 性 、 稳 定性 和 速 
度 有 关 的 参数 。 这 些 命令 如 下 (图 9. 5): 

(1) 地 形 适 应 模式 。 通 过 该 命令 可 以 定义 地 面 探测 和 高 度 / 姿 态 控制 的 可 能 
性 。 操 作 员 可 以 选择 从 平坦 的 地 形 模式 (不 需要 保持 身体 高 度 和 姿态 ， 也 不 需要 
检测 足 部 接触 ) Bi Meru AK HHT Bk, SPE Riz oh 

(2) 腿 部 工作 空间 。 可 以 选择 总 腿 部 工作 空间 的 不 同 子 集 ， 以 便 通过 使 用 宽 
(尽管 很 短 〉 的 工作 空间 来 改善 全 方向 运动 ， 或 通过 使 用 高 BERE) 的 工作 
空间 来 增强 对 不 规则 地 形 的 适应 性 。 

(3) 最 小 稳定 裕 度 。 为 了 增加 机 器 的 稳定 性 或 降低 锁 死 的 可 能 性 ， 可 以 改变 
施加 到 步 态 计 划 器 的 最 小 绝对 稳定 裕 度 Ssmmin o 

(4) 机 体高 度 和 迈步 高 度 。 通 过 这 些 控制 ， 操 作 员 可 以 改变 平均 机 体高 度 和 
迈步 高 度 ， 以 优化 斜坡 、 平 坦 地形 、 崎 赋 地 形 等 的 运动 。 

(5) 速度 。 用 户 可 以 调整 运动 中 使 用 的 不 同 基本 运动 的 速度 。 
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图 9.5 步行 环境 


9.2.9 致 动 器 环境 


使 用 致 动 器 环境 中 包含 的 命令 ， 操 作 员 可 以 手动 移动 任何 单 轴 或 致 动 器 组 
(例如 腿 )。 如 上 所 述 ， 该 接口 的 主要 目标 之 一 是 简化 机 器 人 的 安全 操纵 (协同 控 
制 )。 但 是 ， 在 调试 阶段 或 系统 错误 的 情况 下 需要 底层 控制 。 为 了 从 这 些 命令 中 
分 析 操 作 员 需求 ， 致 动 器 环境 已 经 在 单独 的 窗口 (Axis Control) 中 实现 多 模式 
接口 (图 9.6)。 致 动 器 环境 的 主要 特征 如 下 : 

d) 操作 员 可 以 选择 影响 后 续 命 令 的 机 器 人 〈 腿 或 机 体 ) 的 元 素 。 

(2) 可 以 在 四 种 运动 类 型 之 间 切 换 : 中 独立 轴 位 置 运动 ; 四 独立 轴 速 度 控 
制 ， 包 足 端 协调 运动 ， 四 足 端 直线 运动 。 如 果 机 体 被 选中 ， 只 有 直线 运动 可 用 。 

(3) 运动 命令 的 位 置 增 量 (Pos. Step) 和 速度 (Speed) 都 可 以 使 用 两 个 数 
字 控 制 进行 调整 。 放 置 在 致 动 器 环境 左 侧 的 运动 控制 允许 操作 员 移 动 步行 机 器 人 
的 所 选 部 分 。 这些 命 令 根 据 所 选择 的 操作 模式 分 为 3 个 按钮 阵列 (增加 、 停 止 、 
减 小 ) ， 用 于 移动 足 : 四 在 协调 或 直线 的 情况 下 ， 沿 着 z、y 或 z 轴 运 动 ; OF 
单 轴 运 动 的 情况 下 ， 绕 关节 1、 关 节 2 和 关节 3 旋转 。 

(4) 所 选 腿 的 位 置 显 示 在 涉及 不 同 坐标 系 的 内 部 或 笛 卡 儿 坐 标 中 的 运动 控制 旁边 。 

(5) 机 体 围绕 x、y 和 > 轴 的 旋转 可 以 通过 使 用 位 于 致 动 器 环境 〈 欧 拉 角 
Pitch, Roll, Yaw) 左 侧 的 运动 控制 来 控制 。 

(6) 致 动 器 环境 中 还 包含 若干 控制 命令 ， 以 便于 执行 某 些 有 用 或 频繁 的 操 
作 ， 例 如 轴 初 始 化 。 
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图 9.6 致 动 器 环境 


9.2.10 命令 行 界 面 


一 方面 ， 上 面 描述 的 大 多 数控 制 命令 已 经 在 基于 命令 行 的 接口 中 复制 ， 以 便 
提供 更 准确 的 输入 数据 的 方式 (图 9.1) 。 另 一 方面 ， 命 令 行 界面 是 为 机 器 人 定 
义 复杂 轨迹 的 位 置 。 运 动 开 始 之 前 ,一 些 简单 的 命令 允许 操作 员 进 行 简单 轨迹 的 
编程 ， 指 定 运动 的 类 型 ( 蟹 行 、 转 弯 或 旋转 )、 步 行 总 距离 、 和 做 行 角 等 。 这 提供 
了 一 个 准确 的 方式 来 跟踪 前 置 轨迹 ， 减 少 操作 员 对 机 器 的 密集 监视 。 


9.2.11 协作 环境 


协作 对 话 框 是 通过 一 个 专门 的 对 话 框 执行 的 ， 当 机 器 人 询问 操作 员 时 ， 该 对 
话 框 将 自动 打开 。 当 操作 员 想 要 询问 机 器 人 时 ,可 以 通过 点 击 特定 按钮 (图 9. 1 
中 的 对 话 按钮 ) 打开 类 似 的 对 话 框 。 对 话 包括 关于 机 器 人 状态 、 机 器 人 运动 和 环 
境 条 件 的 几 个 问题 ， 以 及 “是 /和 否 ” 或 数字 类 型 的 答案 。 机 器 人 控制 器 和 人 机 界 
面 之 间 的 协作 始终 是 活跃 的 ， 即 使 是 处 于 非常 低 的 频次 。 例 如 ， 在 致 动 器 环境 
中 ， 假 设 操作 员 可 以 移动 任何 关节 或 任何 腿 部 ， 但 是 如 果 该 运动 改变 了 机 器 人 的 
静态 稳定 性 ， 则 操作 员 将 被 警告 。 

协作 对 话 框 在 防止 运动 失败 中 也 是 有 用 的 。 为 了 做 到 这 一 点 ， 控 制 器 通知 可 
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能 的 危险 情况 并 请 求 用 户 命令 。 例 如 ,来自 倾斜 仪 的 数据 可 以 提示 由 足 端 打滑 引 
起 的 异常 身体 姿态 。 在 这 种 情况 下 ,作为 预防 措施 ， 机 器 人 可 以 要 求 操作 员 进 行 
手动 (远程 操作 ) 的 姿态 恢复 。 如 果 用 户 不 提供 此 操作 ， 机 器 人 将 尝试 使 用 自己 
的 姿态 控制 器 恢复 姿态 。 以 类 似 的 方式 ， 基 于 由 力 传感器 和 足 部 电位 器 提供 的 数 
据 ， 控 制 器 还 可 以 估计 足 是 否 被 正确 地 放置 在 地 形 上 ， 或 者 如 果 由 不 正确 的 位 置 
引起 足 尖 倾 翻 是 否 可 能 。 在 这 种 情况 下 ,协同 控制 器 可 以 要 求 操作 员 对 立足 点 准 
许 或 者 更 换 。 如 上 所 述 ， 协 同 对 话 框 还 有 助 于 确定 某 些 步 态 参数 ， 以 改善 地 面 适 
应 性 并 优化 不 规则 地 形 上 的 运动 。 例 如 ， 当 机 器 人 在 斜坡 上 行走 时 ， 可 以 改变 机 
器 人 的 姿态 ， 将 其 调整 到 地 形 的 平均 斜率 。 这 时 ， 可 以 使 腿 部 工作 空间 中 包含 的 
地 形 表面 最 大 化 ， 从 而 增加 可 触及 (潜在 的 ) 立足 点 的 数量 ”并 减少 锁 死 的 可 能 
性 。 在 这 种 情况 下 ， 机 器 人 根据 地 形 的 历史 数据 进行 斜率 估计 ， 通 过 对 话 窗口 提出 
新 的 机 体 姿态 ， 操 作 员 可 以 接受 或 拒绝 。 最 后 ， 当 用 户 查询 时 ， 协 作对 话 框 可 以 通 
知 机 器 的 状态 或 运动 算法 的 变更 。 表 9. 1 总 结 了 当前 HMI 版 本 中 的 询问 和 应 答 。 


表 9.1 协作 对 话 中 的 询问 和 应 答 
机 器 人 操纵 员 机 器 人 响应 


(1) 使 用 足 位 置 、 倾 斜 仪 的 稳定 性 图 数据 和 力 传感器 数据 。 
(2) 地 形 适 应 : 

你 好 吗 ?〈 状 态 ) 1) . 

2) 被 阻止 : 一 只 足 不 能 碰 地 面 或 者 它 不 能 被 抬 起 来 。 

(3) 锁 死 概率 : 数值 数据 A) 


(1) 使 用 倾斜 仪 估计 地 形 坡 度数 据 和 足 的 位 置 数据 。 


境 怎 么 样 ? 
环境 怎么 样 ? (2) 禁区 百分比 
机 器 人 到 操作 员 操作 员 的 响应 t 释 

我 可 以 改变 我 的 机 体 姿态 吗 ? EIT 它 可 以 减少 锁 死 的 可 能 性 

我 可 以 旋转 我 的 机 体 与 轨迹 对 齐 吗 ? E/S 它 可 以 降低 锁 死 的 可 能 性 并 提高 速度 

= x Z 

Sree Mea OEE | age 在 这 样 做 时 ， 稳 定性 下 降 

碍 吗 ? 

我 应 该 降低 我 的 机 体 沿 着 这 个 斜 eee 它 可 以 增加 稳定 性 和 速度 ， 但 是 如 果 机 器 
坡 吗 ? 人 开始 息 坡 ， 速 度 会 降低 

我 可 以 减 小 迈步 高 度 吗 ? E/E 如 果 地 形 平滑 ,机 器 人 的 速度 可 能 会 增加 

足 N 是 否 在 地 面 上 得 到 充分 支持 ? 是 / 否 电位 计 读 数 表示 奇怪 足 的 姿势 

ik N 已 经 损坏 了 : 

(1) 我 可 以 再 试 一 次 吗 ? A 

(2) 我 可 以 尝试 一 个 不 同 的 立足 点 吗 ? ee ee 

(3) 你 可 以 给 我 立足 点 坐标 吗 ? 


操作 者 注意 力 的 可 用 度 (当前 确定 为 用 户 查询 和 用 户 响 应 之 间 的 固定 延迟 周 
期 的 功能 ) 应 由 操作 员 明 确 地 调整 (或 者 由 系统 以 某 种 方式 确定 )， 以 避免 不 必 
要 的 延迟 。 这 时 ， 当 操作 员 注 意 力 不 可 用 时 获得 的 性 能 可 能 类 似 于 由 自主 控制 器 
获得 的 性 能 。 


9.3 结论 


步行 机 器 技术 研究 主要 集中 在 生产 自主 步行 机 器 上 。 然 而 ， 在 工业 和 服务 步 
行 机 器 人 的 许多 应 用 中 ， 不 同 层次 的 人 为 干预 将 是 强制 性 的 。 本 章 介绍 了 HMI 
开发 的 用 于 引导 具有 协作 和 多 模式 属性 的 步行 机 器 人 ， 而 且 它 已 经 用 于 SILO4 
机 器 人 。 
。 操作 员 可 以 指挥 不 同 级 别 的 控制 器 ， 从 单个 关节 到 顶层 任务 (多 模式 )。 
形 用 户 界面 由 其 功能 组 织 成 一 组 命令 和 显示 ， 称 为 环境 。 Sn 
了 便于 机 器 人 〈 路 径 规划 ) 的 顶层 控制 ， 并 且 监 视 自 由 步 态 生 成 。 经 验 丰富 的 操 
作 员 也 可 以 使 用 底层 控制 。 

此 外 ， 人 允许 机 器 人 询问 人 类 关于 如 何 实现 任务 的 问题 ， 并 决定 如 何 使 用 、 修 
改 或 拒绝 这 些 指令 (协作 )。 因 此 ， 机 器 人 协助 操作 员 ， 通 过 它 和 人 协作 实现 任 
务 。 协 同 控制 有 助 于 优化 不 规则 地 形 的 运动 ， 改 善 地 面 适应 性 ， 并 防止 较 差 传 感 
信息 输入 的 复杂 机 器 的 故障 ， 需 要 灵活 方式 的 人 工 参与 。 操 作 员 的 密切 注意 会 产 
生 更 好 的 适应 性 和 安全 性 ， 并 且 不 需要 注意 产生 的 自主 行为 。 

HMI 被 证 明 是 步 态 分 析 和 设计 的 有 用 工具 。 经 过 对 SILO4 步行 机 器 人 在 自 
然 地 形 的 多 次 模拟 和 实验 ， 对 HMI 的 评估 是 肯定 的 [第 4 章 和 (Estremera， 
2003) |. 
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PHA SILO4 步行 机 器 人 


A.1 简介 


SILO4® 步行 机 器 人 是 用 于 基础 研究 和 开发 以 及 教育 自 的 的 中 型 四 足 机 器 
(图 1.11)。SILO4 是 一 款 紧 次 、 模 块 化 、 坚 固 耐用 的 机 器 人 ， 能 够 通过 不 规则 
地 形 ， 克 服 高 达 0. 25m 的 障碍 物 ， 并 以 约 1. 5m/min 的 最 大 速度 ， 承 载 约 15kg 
的 有 效 载 荷 ， 具 体 参 数 取决 于 所 使 用 的 步 态 。 

鉴于 其 在 教育 和 基础 研究 中 的 用 途 ， 机 器 人 的 总 重量 被 认为 是 一 个 重要 指 
标 。 步 行 机 器 在 调试 过 程 中 错误 恢复 较 困 难 ， 有 时 需要 手动 处 理 。 因 此 ， 成 年 人 
可 以 携带 的 轻型 机 器 极为 重要 。 此 外 ， 轻 型 设备 比 大 型 机 器 便宜 ， 低 成 本 是 教育 
机 器 人 的 基本 要 求 。SILO4 配置 为 四 足 机 器 人 ， 四 足 动物 的 步 态 生 成 和 稳定 性 
比 六 足 动物 更 难 ， 因 此 ， 四 足 动物 的 研究 更 具 吸 引力 。 

SILO4 被 认为 是 室内 步行 机 器 人 ， 但 它 可 以 在 非 极 端 条 件 下 的 户外 环境 中 
工作 。 例 如 ， 机 器 人 可 以 在 高 度 不 规则 的 地 形 上 工作 ,但 不 能 在 多 雨 的 条 件 下 
工作 。 

SILO4 步行 机 器 人 具有 以 下 主要 特点 : 

(1) 4 条 腿 。 

(2) 体积 小 、 重 量 轻 ， 便 于 携带 。 

(3) 机 械 结 构 坚 固 。 

(4) 细 长 ， 避 免 了 电机 位 置 腿 部 体积 过 大 。 

(5) 紧凑 性 ， 所 有 电机 和 电缆 均 可 方便 安装 。 

(6) 可 灵活 地 改变 轨迹 ， 实 现 良 好 的 全 向 性 。 

(7) 由 支持 实时 网 络 通 信 的 实时 多 任务 操作 系统 控制 。 

SILO4 机 器 人 机 制 的 详细 描述 可 以 在 Galvez 等 (2000) 论文 中 和 SILO4 
(2005) 找到 。 


@ ”西班牙 语 首 字母 缩写 ， 意思 为 四 足 运动 系统 。 
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LA SILO4 步行 机 器 人 


A.2 机 械 结 构 


SILO4 的 机 械 结 构 由 放置 在 机 体 周围 的 四 条 相似 的 腿 组 成 。 足 与 地 面 接触 ， 
并 可 采用 不 同 结构 的 腿 部 末端 致 动 器 或 装置 。 以 下 介绍 机 器 人 布局 、 机 喘 结构 、 
腿 部 配置 和 足 部 设计 。 


A.2.1 机 器 人 布局 


SILO4 的 腿 以 圆 形 布 局 放置 在 机 体 周围 。 由 于 静态 稳定 的 步行 机 器 人 关于 
纵向 和 横向 轴线 对 称 分 布 ， 该 布局 增强 了 全 向 性 和 机 动 性 。 然 而 与 其 他 布局 相 
比 ， 其 可 实现 的 最 大 速度 较 低 。 例 如 ， 类 似 哺乳 动物 构造 中 那样 腿 部 放置 平行 于 
身体 的 纵向 轴线 时 ， 机 器 人 平均 速度 可 以 更 高 ， 因 为 更 好 地 利用 腿 部 步 幅 。 但 从 
研究 的 角度 来 看 ，SILO4 布局 在 全 向 性 和 机 动 性 方面 开辟 了 新 算法 ， 因 此 从 这 
个 意义 上 SILO4 布局 是 有 利 的 。 


A.2.2 机 身 结构 


SILO4 的 主体 类 似 于 大 约 0.31mX0.30mX0. 30m 的 平行 六 面体 。 它 包含 驱 
动 器 、 电 路 板 、 力 传感器 、 放 大 器 和 提供 俯仰 和 滚动 体 角度 的 双 轴 倾斜 仪 。 机 体 
结构 由 铝 制 成 ， 重 量 约 为 14kg。 

机 体 的 上 部 是 平板 ， 可 以 安装 辅助 设备 和 外 部 感应 传感器 ， 如 电视 摄像 机 和 
激光 测 距 仪 。4 个 出 壁 也 可 用 于 相同 的 目的 。 


A.2.3 腿 部 配置 


机 器 人 的 腿 部 基于 类 昆虫 构造 ， 即 第 2 和 第 3 关节 的 轴线 彼此 平行 并 垂直 于 
第 1 关节 的 轴线 (图 1. 11 和 图 A.1)。 第 1 个 连 杆 长 约 0.06m， 第 2 和 第 3 关节 
长 约 0. 24m。 每 个 关节 由 具有 永 磁 定 子 和 无 铁 芯 自持 线圈 绕组 转子 的 直流 伺服 电 
机 驱动 。 电 动机 骨 入 在 腿 部 结构 中 ， 从 而 使 腿 部 变 细 ， 有 助 于 避免 碰撞 。 电 机 配 
有 行星 齿轮 。 行 星 齿轮 的 输出 轴 直 接 驱动 第 1 关节 。 第 2 和 第 3 关节 具有 基于 交 
错 轴 螺旋 机 构 的 附加 减速 器 。 

螺旋 齿轮 包括 类 似 于 蜗杆 的 锥 形 齿 轮 和 具有 沿 长 度 方向 螺旋 的 齿轮 。 螺 旋 齿 
轮 放 在 螺旋 斜面 蜗杆 和 面 齿轮 之 间 的 位 置 。 这 种 结构 比 其 他 任何 形式 更 坚固 ， 并 
允许 较 小 的 重量 、 尺 寸 和 更 高 的 减速 比 。 图 A.2 (a) 显示 了 一 个 螺旋 齿轮 ， 图 
A.2 (b) 显示 了 齿轮 如 何 安 装 在 关节 2 和 关节 3 中 。 

腿 部 主要 用 铝 材 料 制 成 ,但 一 些 必须 承受 高 应 力 的 特定 部 件 由 铝 7075T6 制 
成 。 腿 重 约 4kg， 包 括 足 。 表 A. 1 总 结 了 腿 关 节 的 主要 特征 。 其 余 的 机 械 特 征 可 
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附录 A SILO4 步行 机 器 


足 
heh he + ~ 
# 4 | 
| ”被 动 关节 (Be) 


=> 


图 A.1 SILO4 腿 


S 
| 
| 


(a) 螺旋 齿轮 实物 图 Cb) 安装 在 腿 部 的 第 2 和 
第 3 关节 处 的 螺旋 齿轮 


图 A.2 螺旋 齿轮 
以 在 表 6. 2 一 表 6.7 中 找到 。 


A.2.4 足 部 设计 
标准 的 SILO4 足 部 由 一 个 被 动 的 万 向 节 组 成 ， 通 过 另 一 个 被 动 关节 将 第 3 
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A SILO4 步行 机 器 人 


-----> 


# A.1 SILO4 步行 机 器 人 的 腿 关 节 特 征 
参 数 KW 1 关节 2 关节 3 
电 宙 类 到 MINIMOTOR MINIMOTOR ee 
3557K024C 3557K024CR 3557K024CS 
电机 功率 /W 14 72 26 
电机 空 载 转速 /(r* min !) 4800 5300 5500 
电机 失速 转 矩 /(mN + m) 105 510 177 
减速 机 速 比 246:1 14:1 14:1 
螺旋 齿轮 速 比 | = 20.5 21 20.531 
编码 器 HEDS5540A14 HEDS5540A14 HEDS5540A14 
SRG ft BE/ CO) +80 +45~—90 十 10 一 一 135 


个 连 杆 与 一 个 圆 形 硅 底 连接 起 来 ， 这 


文 3 个 被 动 关节 使 圆 形 面 足 底 与 地 面 有 足够 的 


接触 。 足 和 第 3 连 杆 之 间 的 角度 可 以 通过 两 个 电位 计 测 量 。 位 于 被 动 关节 上 方 第 
3 个 连 杆 的 三 轴 力 传感器 测量 足 部 和 地 面 [图 A. 3 (a)] 的 接触 力 。 从 这 些 传 感 
器 获取 的 数据 可 用 于 运行 力 控制 算法 ， 以 改善 在 松软 和 不 规则 地 形 的 运动 。 也 可 
以 使 用 没有 力 传 感 器 的 更 简单 的 匀 接 足 [图 A.3 b] 和 具有 被 动 关节 的 半球 形 
E [图 A.3 0], 后 者 特别 适用 于 硬 质 地 面 。SILO4 有 3 个 特征 为 图 A.3 (a) ~ 
(c) 的 原型 足 ， 分 别 由 工业 自动 化 研究 所 [CSIC (西班牙 )]，Ecole Nationale 
Suprieure d’Ingnieurs de Bourges - ENSI (法 国 ) 和 Murcia 大 学 (西班牙) ix 
计 。 表 A.2 总 结 了 SILO4 步行 机 器 人 的 主要 机 械 特 征 。 


Ca) 带 三 轴 力 传感器 的 铵 接 足 


Ch) 带 单 轴 力 传感器 的 匀 接 足 (c) FREE 


图 A.3 SILO4 足 的 配置 
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数值 /配置 
4 

昆虫 (三 旋转 关节 ) 

圆 形 配 置 


站 每 个 连 杆 0. 24m 
0. 20m/s 
铝 7075T6 
足 底 
足 足 关节 1 或 3 个 被 动 关节 ( 见 腿 设计 部 分 ) 


铝 7075T6 和 钢 
0.31mX0. 31mX0. 30m 
a 


~30kg 


A.2.5 运动 学 
1. 正 向 运动 学 
SILO4 机 器 人 的 正 向 运动 学 方程 在 6. 2 HES, 为 
X=Ci(asCrtasCstai) (A.1) 
y=Si(a3Czs 十 az Ca +a, ) (A. 2) 
z=a; Sn ta: Sz CA. 3) 


其 中 连 杆 参数 w 和 关节 变量 0; 在 图 6. 2 中 定义 ， 其 值 见 表 6.1。 记 住 C= 
cos(0:), S;=sin(0;), C;=cos(b;+0,) 和 S; 一 sin(4 十 0 ) 。 


2. 逆向 运动 学 
SILO4 机 器 人 的 逆向 运动 学 方程 ， 也 在 6. 2 节 推 导 ， 为 
0, =arctan[2(y,x) | (A. 4) 
6, = —arctanl2(B,A) ]+arctan[2(D, + PBR (A. 5) 
6; =arctan[ 2(z—az,S,,xC, + yS; —a2C;, —a,) ]—0 (A. 6) 
3. FET th ee 
SILO4 腿 的 雅 可 比 矩 阵 应 用 在 第 5 章 ， 为 
=S] (a3Cz3 Fa2C,+a,) —C,(a3So3+a2S2) azr 
J=| C,(€a;Cy, +a:C, +a) —'S; (aSa taS). dds (A. 7) 
0 azCz3 +a2C, a3 C23 
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A SILO4 步行 机 器 人 


雅 可 比 和 矩阵 的 推导 超出 了 本 书 的 范围 。 
A.3 控制 系统 配置 


SILO4 设想 是 由 操作 员 远 程 遥 挖 自主 机器人， 操作 者 负责 定义 机 器 人 运动 
的 主要 特征 ， 例 如 速度 和 运动 方向 。 管 理 者 站 位 于 远 处 ， 主 要 通过 电信 号 线 进行 
通信 ， 同 时 满足 电源 供应 。 无 线 电 通信 和 电池 也 可 以 轻松 地 安装 在 机 器 人 上 。 因 
此 ，SILO4 整 机 系统 有 两 种 不 同 的 配置 。 在 第 一 种 配置 中 ， 机 器 人 上 有 唯一 一 
台 计 算 机 。 计 算 机 和 机 器 人 电机 通过 外 部 线 供 电 ， 该 线 还 用 于 计算 机 屏幕 和 键盘 
电缆 的 延伸 (SULA A.4 中 的 配置 1) 。 在 第 二 种 配置 中 ， 有 两 台电 脑 ， 即 机 载 
计算 机 和 操作 台 。 机 器 人 控制 器 在 板 载 计算 机 上 和 运行， 其 电源 与 机 载 电 机 的 电源 
一 起 由 机 载 电 池 供 电 。 机 载 计 算 机 和 操作 员 站 之 间 的 通信 通过 串 行 无 线 电线 路 运 
47 (参见 图 A.4 中 的 配置 2) 。 
显示 器 机 载 计 算 机 


电源 


ae 


ra 
键盘 和 VGA 放大 器 
Ca) 配置 1 
无 线 电 链 路 
操作 员工 作 站 
电池 
Cb) 配置 2 


图 A.4 SILO 系统 配置 


A.3.1 计算 系统 


安装 在 机 器 人 上 的 控制 系统 是 由 基于 PC 的 计算 机 、 数 据 采 集 板 和 基于 
LM629 微 控制 器 的 4 个 三 轴 控 制 板 组 成 的 分 布 式 分 层 系统 ， 通 过 ISA 总 线 互 连 。 
LM629 微 控制 器 包括 带 有 轨迹 发 生 占 的 数字 PID 校正 器 ， 用 于 对 每 个 关节 的 位 
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置 和 速度 执行 闭环 控制 。 每 个 微 控 制 器 都 基于 PWM 技术 控制 直流 电机 关节 驱动 
器 。 模 拟 数据 采集 板 用 于 从 不 同 的 本 体感 应 传感器 获取 感官 数据 。 可 以 根据 系统 
中 使 用 的 传感器 添加 附加 组 件 。 例 如 ， 如 果 使 用 压 电 力 传感器 ， 则 如 图 A.3 (a) 
所 示 ， 会 包括 一 些 电 荷 放 大 器 。 

SILO4 硬件 架构 的 总 图 如 图 A. 5 所 示 。 这 是 迄今 为 止 3 个 SILO4 机 器 人 中 
使 用 的 硬件 配置 。 人 然而 ,鼓励 研究 人 员 测 试 其 他 配置 ， 以 便 进行 比较 。 


AS Ens 
主机 
oiim 


模拟 量 到 
数字 量 
转换 器 


PC 总 线 


直流 电机 十 编码 器 


sk 
一 和 有 


直流 电机 十 编码 器 


3 轴 控 制 板 4 


图 A,5 SILO4 硬件 架构 
199 


SILO4 步行 机 器 人 


A.3.2 传感器 和 传感器 系统 


SILO4 步行 机 器 人 不 具有 外 部 感应 传感器 。 外 部 传感器 集成 是 潜在 用 户 完 
成 的 任务 。 作 为 内 部 传感器 ， 该 机 器 在 每 个 关节 上 使 用 编码 器 作为 位 置 传感器 ， 
采用 通过 轴 控 制 的 位 置 闭 环 。 一 对 正 交 倾斜 仪 也 用 于 将 机 体 保 持 在 给 定 的 姿态 。 
根据 使 用 的 足 部 类 型 ， 机 器 可 以 包括 不 同 的 传感器 。 如 果 机 器 具有 用 力 传感器 的 
贸 接 足 ， 则 传感器 系统 每 个 足 可 以 具有 三 轴 力 传感器 和 两 个 电位 器 。 使 用 这 些 传 
感 器 ， 系 统 可 以 检测 足 / 地 面相 互 作用 或 实施 力 分 配 技术 。 如 果 贸 接 足 没有 力 传 
感 器 ， 则 传感器 系统 可 以 在 每 个 足 底 上 并 和 人 ON/OFF 开关 ， 用 于 地 面 检测 。 对 
于 固定 足 配 置 ， 系 统 不 包括 任何 传感器 ， 并 且 可 以 通过 基于 使 用 编码 器 数据 作为 
网 络 输入 的 神经 网 络 的 虚拟 传感器 执行 接 足 地 检测 (第 8 章 )。 事 实 上 ， 后面 的 
策略 可 以 适用 于 任何 类 型 的 足 。 

机 器 人 中 没有 安装 绝对 传感器 来 确定 编码 器 的 原点 。 当 给 定 的 关节 向 机 械 极 
限 移 动 时 ， 通 过 检查 位 置 误差 来 完成 该 任务 。 如 果 位 置 误差 突然 增加 ， 则 假定 达 
到 机 械 极 限 。 因 此 ， 不 需要 绝对 传感器 〈 开 关 、 感 应 式 或 接近 传感器 等 )， 并 且 
也 避免 了 从 控制 器 向 每 个 关节 连接 更 多 电缆 的 繁琐 责任 。 


A.3.3 控制 算法 


车 载 电 脑 负 责 步 态 生 成 、 轨 迹 生 成 、 运 动 学 计算 、 信 号 处 理 和 用 户 界面 以 及 
微 控 制 器 的 协调 。 这 些 任务 分 布 在 由 自 下 而 上 开发 的 层 组 成 的 软件 架构 中 。 这些 
层 可 以 主要 分 为 (图 A. 6): 

(1) 硬件 接口 。 该 层 包 含 软件 驱动 程序 。 

(2) 轴 控 制 。 该 层 执行 基于 PID 控制 器 的 机 器 人 单个 关节 的 控制 。 

(3) 腿 部 控制 。 该 层 负责 协调 腿 部 的 所 有 3 个 关节 以 执行 协调 的 运动 。 

(4) 腿 部 运动 学 。 该 层 包含 腿 的 正 向 和 反 向 运动 学 功能 。 

(5) 轨迹 控制 和 机 器 人 运动 学 。 该 模块 负责 协调 所 有 4 条 腿 的 同步 运动 ， 以 
执行 直线 或 圆周 运动 。 

(6) 运动 过 程 。 该 模块 执行 地 形 适 应 、 姿 态 控 制 和 高 度 控 制 算法 。 

(7) 稳定 性 模块 。 该 层 确定 给 定 的 足 端 位 置 是 否 稳定 。 

(8) 步 态 发 生 器 。 该 层 产 生 一 个 腿 部 抬 起 和 足 部 放置 顺序 ， 以 稳定 的 方式 移 
动机 器 人 。 稳 定性 模块 保证 静态 稳定 性 。SILO4 步 态 发 生 器 基于 不 连续 步 态 、 
H HETES, We Fe AE AS ARK AE AS 4 个 步 态 (第 3 章 、 第 4 章 )。 

(9) 传感器 模块 。 处 理 机 器 人 不 同 传感器 采集 的 数据 。 

(lo) 图形 和 用 户 界面 。 此 图 层 包 含 用 于 在 计算 机 屏幕 上 绘制 机 器 人 姿态 的 
简单 图 形 表示 以 及 HMI 对 话 框 。 
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附录 ASILO4 步行 机 村 


a 
ia 


=o o FS = Se a a O 


图 A.6 SILO4 软件 架构 


该 软件 运行 在 QNX 环境 下 ， 是 一 个 多 任务 的 实时 操作 系统 ， 可 提供 网 络 支 
持 。 最 后 一 个 特征 通过 串 行 线路 或 以 太 网 来 支持 与 其 他 系统 的 通信 ， 以 便 使 分 布 
式 系统 和 远程 机 器 人 操作 变 得 可 行 。 控 制 系统 的 底层 通过 可 在 QNX 或 MS - 
Windows 操作 系统 下 编译 的 C++ 语言 库 实 现 。QNX 操作 系统 的 Photon Applica- 
tion Builder 用 于 开发 HMI, 

图 A. 6 说 明了 不 同 的 软件 模块 及 其 相互 关系 。 软 件 体系 结构 以 及 HMI 中 的 
PEAS C++ 代码 可 以 从 SILO4 (2005) 获得 。 


A SILO4 步行 机 器 人 


A.4 模拟 工具 


为 了 初步 研究 机 器 人 的 功能 ， 研 发 了 SILO 的 模拟 工具 。 该 模拟 工具 基于 
商业 模拟 软件 框架 〈Yobotics，2002)， 并 考虑 了 机 器 人 的 运动 学 和 动力 学 以 及 
地 形 模型 和 足 / 地 面 接触 模型 。 可 以 定义 每 个 关节 的 控制 规律 ， 并 通过 可 变 面板 、 
图 形 和 3D 图 形 窗口 获得 输出 数据 。 所 有 控制 变量 以 及 所 有 系统 变量 都 可 在 变量 
面板 中 获得 。 可 以 选择 变量 作为 时 间 的 函数 来 绘制 图 形 区 域 。 仿 真 工具 可 以 使 用 
标准 软件 包 导 出 所 有 数据 进行 绘图 。 最 后 ，3D 图 形 窗口 可 以 在 定义 的 地 面 模型 
上 显示 机 器 人 的 3D 动画 。 这 是 一 个 非常 强大 的 工具 ， 用 于 在 实际 机 器 中 进行 测 
试 之 前 设计 和 调试 新 的 步 态 和 控制 算法 ， 或 者 在 其 负载 分 布 发 生变 化 时 检查 机 器 
人 的 行为 。 模 拟 程序 集 是 用 Java 语言 编写 的 函数 集合 ， 可 以 从 Yobotics (2002) 
获得 。 从 SILO4 (2005) 可 以 获得 用 于 构建 SILO4 模拟 器 的 SILO4 机 器 人 的 资 
料 。 该 模拟 工具 详 见 附录 B。 


A.5 制造 图 纸 


SILO4 步行 机 器 人 的 整 机 机 械 设计 可 从 互联 网 获得 (SILLO4，2005)。 图 纸 包括 材 
料 、 尺 寸 和 所 需 的 机 械 精 度 ， 并 可 用 于 制造 ， 还 包括 零件 清单 。 图 A.7 仅仅 是 制造 
图 的 一 个 例子 ， 图 A. 8 显示 如 何 连接 所 有 部 件 。 数 字 表 示 不 同 部 分 的 图 纸 编 号 (SI- 
LO4，2005)。 例 如 ,图 A.7 绘制 了 件 14 的 工程 图 ， 即 如 图 A. 8 中 所 示 的 件 14。 


A.6 结论 


步行 机 器 与 传统 车 辆 相 比 显示 出 许多 优点 ， 然 而 ， 在 应 用 于 工业 和 服务 业 之 
前 还 有 很 长 的 路 要 走 :- 问题 是 研究 人 员 没 有 可 用 于 比较 算法 的 通用 测试 平台 。 有 
些 商业 平台 可 以 在 市 场 上 购买 ， 但 缺乏 可 维护 性 、 地 形 适应 性 、 零 件 更 换 等 重要 
功能 。 对 于 步行 机 器 技术 的 任何 实际 改进 的 比较 都 是 至 关 重 要 的 ， 但 只 有 通过 使 
用 类 似 的 机 器 才能 进行 有 效 比 较 。 

为 了 克服 这 些 问 题 ，IAI- CSIC 根据 其 在 以 前 的 3 台 步 行 机 器 的 制作 经 验 开 
发 了 SILO4 步行 机 器 人 ， 并 将 其 在 互联 网 上 的 完整 设计 提供 给 愿意 自己 制造 副 
本 的 其 他 研究 团队 〈SILO4，2005)。 设 计 的 主要 目的 是 配置 和 开发 一 个 小 巧 、 
易 操 作 、 可 靠 的 步行 机 器 人 ， 具 有 良好 的 地 形 适 应 性 和 全 方位 性 。 

这 些 书 籍 的 作者 鼓励 其 他 研究 人 员 分 享 SILO4 设计 ， 作 为 可 比较 步行 机 器 
人 ， 并 希望 为 开发 新 技术 作出 贡献 。 
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附录 A SILO4 步行 机 
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图 A.7 SILO4 步行 机 器 人 的 制造 图 示例 


图 A.8 列 出 SILO4 步行 机 器 人 的 零件 
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PHI B 步行 机 器 人 仿真 软件 


B.1 简介 


Yobotics! 模拟 结构 集 (SCS) CYobotics, 2002) 是 由 Yobotics Inc. 开发 
的 软件 包 ， 用 于 方便 快速 地 创建 机 械 装 置 、 生 物力 学 系统 和 机 器 人 的 图 形 和 数值 
模拟 。 使 用 SCS 创建 的 模拟 涉及 机 器 人 系统 的 运动 学 和 动态 模型 ， 及 地 形 的 几 
何 模型 和 地 面 接触 模型 。 模 拟 结果 如 图 B.1 所 示 。 图 B.1 以 3 种 方式 同时 跟踪 
机 器 人 系统 的 仿真 。 

d) 数值 。 每 个 系统 变量 都 可 通过 变量 面板 进行 访问 〈 图 B. 1)。 可 以 使 用 数 
字 输 入 框 跟踪 模拟 过 程 来 监视 和 修改 诸如 控制 增益 、 稳 定 裕 度 或 模拟 参数 等 变量 。 

(2) 图 形 化 。 系 统 变 量 随 时 间 的 变化 也 在 图 形 面板 中 以 图 形 方式 进行 监控 
(图 B. 1) 。 

(3) 视觉 上 。 模 拟 机 器 人 系统 中 变量 的 变化 也 体现 在 3D 图 形 窗口 中 运行 的 

aaa aa i _ 


natrii Set 


菜单 一 -pn Rom Goons Daapaler C 


3D-graphics window 


工具 栏 


变量 面板 数字 输入 框 图 形 面 板 


图 B.1 使 用 Yobotics 构建 的 SILO4 模拟 屏幕 快照 


204 


附录 B 


步行 机 器 人 仿真 


3D 动画 中 (图 B. 1) 。 因 此 ， 模 拟 机 器 人 的 运动 一 目 了 然 ， 可 提供 有 效 的 反馈 测 
试 控制 算法 。 

仿真 GUI 包括 菜单 栏 和 工具 栏 (图 B. 1)， 用 于 管理 仿真 ， 如 记录 数据 ， 从 
Matlab 导入 和 输出 到 其 他 文件 格式 。 它 还 允许 图 像 捕获 和 影像 记录 生成 。 

接 下 来 的 部 分 将 详细 介绍 如 何 使 用 SCS 创建 用 于 获取 本 书 中 仿真 结果 的 机 
器 人 仿真 。SILO4 四 足 机 器 人 已 被 用 作 创建 模拟 的 模型 。 


B.2 仿真 参数 


用 于 仿真 的 积分 器 基于 四 阶 Runge- Kutta 法 ， 积 分 周期 为 0. 4ms。 此 处 在 
0. 02s 的 采样 时 间 采 集 数 据 进 行 图 形 比 较 。 


B.3 编程 仿真 


仿真 以 Java 语言 编程 ， 它 分 成 以 下 几 类 (图 B. 2) : 


地 面 接触 模型 


器 人 


模拟 


图 B. 2 Yobotics 模拟 结构 集 类 图 


d) 仿真 类 。 包 含 设置 模拟 参数 的 功能 ， 如 积分 时 间 步 长 、 摄 像 机 位 置 、 图 中 
最 初 绘制 的 变量 等 。 将 模拟 设置 与 SILO4 机 器 人 相关 联 。 : 

(2) 机 器 人 类 。 定 义 机 器 人 的 几何 和 动力 学 。 机 器 人 由 一 个 关节 树 和 形状 、 
颜色 、 质 量 和 惯性 的 链接 组 成 。 机 器 人 中 定义 了 一 些 接地 点 ， 并 且 对 地 面 接触 模 
型 进行 了 调用 ， 执 行 了 地 面 轮廓 和 控制 器 。 

(3) 控制 器 类 。 机 器 人 运动 的 控制 算法 编程 。SILO4 以 两 相 不 连续 步 态 行 
走 ， 由 状态 机 控制 机 器 人 腿 的 摆动 相 和 支撑 相 。 编 程 足 端 轨 迹 生 成 ， 其 中 足 沿 着 
HA. JF AKA PME PD 控制 的 。 

(4) 地 面 轮 廓 类 。 它 定义 了 地 面 的 形状 ， 如 平面 、 倾 斜 、 不 平坦 等 。 
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(5) 地 面 接触 模型 类 。 这 里 建 模 机 器 人 /地 形 相 互 作 用 的 动力 学 。 用 于 
SILO4 模 拟 的 模型 是 Xo x Yo All 之 0 方向 上 的 弹簧 阻尼 器 。 


B.4 创建 SILO4 机 器 人 


机 器 人 类 定义 了 机 器 人 的 几何 和 尺寸 以 及 运动 和 动态 模型 。 机 器 人 运动 学 定 
义 为 关节 树 。 因 此 ， 机 体 是 根 关 节 ，4 个 枝 关 节 分 别 定义 4 条 腿 。 每 条 腿 由 3 个 
关节 组 成 ;每 个 关节 都 具有 与 之 相关 联 的 连 杆 ， 其 定义 了 结构 的 形状 、 尺 寸 和 颜 
色 。 因 此 ，Robot 类 利用 了 两 个 其 他 类 的 元 素 : 

a) 连 杆 类 。 人 允许 生成 几 种 形状 、 颜 色 和 纹理 的 连 杆 。 定 义 每 个 连 杆 的 质 
量 、 质 心 和 惯性 ， 使 用 Featherstone 算法 从 定义 的 参数 可 以 计算 机 器 人 的 动力 学 
(Featherstone, 1987). 

(2) 关节 类 。 用 于 将 不 同类 型 的 关节 插 人 运动 机 构 中 〈 即 旋转 、 圆 柱 形 、 球 
形 等 ) 。 每 个 连 杆 都 与 一 个 给 定 的 关节 联系 在 一 起 ， 以 保证 Denavit - Hartenberg 
公式 的 适用 性 。 关 节 变 量 将 通过 控制 器 类 进行 控制 ， 并 可 在 变量 和 图 形 面 板 中 进 
行 监控 。 一 旦 机 器 人 运动 学 定义 完成 ， 则 可 定义 接地 点 。 

机 器 人 类 还 通过 调用 地 形 轮 廓 和 地 面 接触 模 型 类 来 定义 地 面 剖 面 和 地 面 接触 
模型 。 


B.5 步 态 控制 


SILO4 机 器 人 使 用 两 相 不 连续 步 态 〈 第 3 章 ) 行走 ， 该 步骤 通过 有 限 状 态 机 
进行 编程 ， 如 图 B. 3 所 示 。 两 条 腿 的 摆动 状态 先 于 每 个 机 体 和 运动， 机体 被 向 前 


ee 
摆动 腿 3 摆动 腿 1 


机 体 运动 机 体 运 动 


摆动 腿 2 摆动 腿 4 


图 B.3 两 相 不 连续 步 态 的 有 限 状 态 机 
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附录 B 步行 机 器 人 仿真 


推进 。 腿 的 摆动 由 在 线 产 生 的 3 个 直线 轨迹 〈 抬 起 、 向 前 运动 和 接地 ) 组成。 机 
体 运动 由 4 条 腿 同时 进行 直线 向 后 运动 形成 。 每 个 轨迹 生成 过 程 确 定期 望 的 关节 
轨迹 ， 其 在 关节 水 平 上 是 由 PD 控制 ， 即 
t=K,(0"—0,)K, (0 —0,) (B. 1) 
式 中 ， 下 标 i 表示 关节 数 ; 9 和 6 分 别 为 关节 位 置 和 速度 ; 90“* 和 09“ 分 别 为 基准 
关节 位 置 和 速度 ; K, A K, 分 别 为 弹性 和 阻尼 常数 。 
式 (B. 1) 中 PD 控制 器 的 输出 是 关节 i 所 需 的 转 矩 Tio 


B.6 地 面 图 


地 形 的 形状 被 设 定 为 相对 于 固定 参考 系 eo yo xo 的 高 程 函数 。 因 此 ，z 方向 
上 的 倾斜 地 形 由 以 下 功能 描述 


Zo 一 QT0 CB: 2) 
式 中 : zo 为 地 形 表面 的 高 度 ; a 为 斜率 。 
一 个 随机 不 平坦 的 地 形 可 以 建 模 为 
z0 一 Aisin(wizo 十 po)Assin(ozyo 十 9z) (B. 3) 


AP: A, MA, 为 粗糙 度 的 幅度 ; w Mo, 为 它们 的 频率 ; wm 和 gs 为 它们 的 
相位 。 


B.7 地 面 接触 模型 


机 器 人 /地 形 相互 作用 的 动力 学 模型 由 3 个 正 交 弹簧 阻 尼 系 统 组 成 ， 分 别 沿 
着 模拟 的 x、y Me 空间 方向 连接 到 足 上 (图 B. 4) 。 每 次 足 的 = 坐标 进入 地 面 轮 


图 B.4 地 面 接触 模型 
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RB 步行 机 器 人 仿真 软件 


廓 时 ， 都 会 对 其 施加 地 面 反 作用 力 ， 其 笛 卡 儿 坐 标 为 


F,=h, (xa xi) —k, Li | (B. 4) 
Fy =k Ya VE — ky yi (B. 5) 
F, =k, (te —21) —ky Zt (B. 6) 


其 中 (zacs + Maes Zas) 是 初始 足 / 地 接触 点 Po AAR ULB. E Cars ys 21) 
是 点 已 的 坐标 ， 其 代表 在 随后 的 任何 瞬间 足 的 位 置 。 

关节 弹性 也 可 以 使 用 地 面 接触 模型 进行 建 模 。 假 设 笛 卡 儿 弹 簧 一 阻尼 模型 的 
KPEE (Shih 等 ，1987) 在 足 接触 地 面 瞬间 ， 腿 的 3 个 关节 的 弹性 效应 的 组 
成 可 以 被 认为 是 足 的 等 效 弹簧 一 阻尼 系统 。 因 此 ， 将 等 效 的 弹性 和 阻尼 常数 添加 
到 地 面 接触 模型 反映 了 步行 期 间 关节 弹性 的 附加 影响 。 

附录 B 描述 的 SILO4 机 器 人 的 仿真 可 以 从 SILO4 (2005) 获得 。 
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